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(54) 发 明 名 称 弹道 仿真 的 多 目标 数值 欠 代 规划 方案 .利用 方向 

一 种 考虑 多 禁 飞 区 约束 的 协同 解析 再 入 制 。 导数 改进 了 拟 牛 顿 法 ,减少 弹道 仿真 次 数 。 
导 方 法 
(57) 摘 要 开始 

本 发 明 一 种 考虑 多 禁 飞 区 约束 的 协同 解析 ee ーー シー 
再 入 制导 方法 ,包括 步 又 :1、 再 入 制导 问题 描述 9 制 き か . 生 定 K 生 員 | | 下 少 
2、 基 于 旋转 地 球 模型 的 飞行 时 间 解 析 解 ;3、 考 虑 。 
多 禁 飞 区 和 抵达 时 间 约 束 的 解析 再 入 制导 方法 ， | 和則 时 间 要 求 ， 和 用 维 程 解 
4、 多 飞行 器 抵达 时 间 协 同方 案 。 本 发 明 优 点 在 剖面 参数 L/Dyows(5,) 和 参数 ， 采用 负 ; ま 代 方 案 划 倾 
于 :(1) 提 出 基于 旋转 地 球 模型 的 高 超声 速 滑翔 。 perorerom | 人 
弹道 飞行 时 间 的 精确 解析 解 , 预 测 误差 保持 在 用 开道 人 真 预测 飞行 = 
3%6 以 内 ,适用 于 非常 值 纵向 升 阻 比 剖面 的 情况 。 ーー 人 人 
(2) 可 基于 三 维 再 入 弹道 解析 解 和 飞行 时 间 解 析 直さ 和 表 | | ーー 
解 ,解决 在 多 禁 飞 区 环境 中 导 引 多 个 高 超声 速 滑 。  ー SA 
翔 飞行 器 同时 到 达 目 标的 协同 飞行 问题 .(3) 设 


计 了 考虑 终端 时 间 、 速 度 和 高 度 要 求 的 基于 在 线 


CN 109508030 B 权 利 要求 书 1/5 页 
1 .一 种 考虑 多 禁 飞 区 约束 的 协同 解析 再 入 制导 方法 ,其 特征 在 于 :该 方法 包括 以 下 几 


个 步骤 : 

步骤 1: 再 入 制导 问题 描述 

采用 圆 球 形 旋 转 地 球 下 的 三 维 再 入 质点 动力 学 模型 ,其 中 利用 经 度 和 纬度 b 和 高 度 H 
划 述 飞行 器 位 置信 息 ,而 用 速率 V、 弹 道 倾角 Y 和 航 向 角 ゅ 描 述 速度 信 候 : 

为 了 保证 飞行 器 的 各 个 子 系统 正常 工作 ,再 入 飞行 轨迹 需要 满足 热流 密度 2 、 来 流动 
压 q、 过 载 n 约 束 ; 考 虑 到 飞 控 系统 能 力 有 限 ,需要 对 攻 角 和 倾 侧 角 范 围 及 变化 率 进行 限制 ; 
除了 常规 约束 ,还 需要 考虑 多 个 圆 形 禁 飞 区 约束 的 情况 ; 

再 入 段 飞 行 在 飞行 器 到 目标 的 水 平 距离 为 Stey 时 终止 ;此 时 期 望 的 终端 高 度 为 Hrapy, 终 
端 速度 为 Vrapy, 终端 航向 误差 | A brapy | 和 终端 倾 侧 角 |ornpy | 满足 约束 条 件 ; 此 外 ,这 里 还 指 
定期 望 的 终端 时 刻 为 trapy; 

步骤 2: 基 于 旋转 地 球 模型 的 飞行 时 间 解 析 解 ， 

为 了 应 对 抵达 时 间 约 束 , 这 里 推导 飞行 时 间 解 析 解 ;能 量 定义 如 下 


2 A 
E=—V*— ] 
2 R.+H (1) 


a 


= 


其 中 ,V 是 速度 ,H 是 高 度 ,Re 是 地 球 平均 半径 ,hu 是 引力 常数 ;能 量 对 时 间 t 的 导数 为 
dE _ dy dH 


i (② 

式 中 g 为 重力 加 速度 ;在 旋转 地 球 背 景 下 ,有 如 下 复杂 的 非 线性 方程 
SH ysin(y) (3) 

dt 

dy 


=-—-gsiny) + (ん + 万 )cos "(の sin⑦) (4) 


—@(R, +H)sin(¢) cos(¢) cos(y)cos(y) 
其 中 , y 是 弹道 倾角 ,D 是 阻力 ,m 是 质量 , w 是 地 球 自转 角速度 , 8 是 纬度 ,是 航向 角 ; 
公式 (4) 中 右辺 第 3 項 だ (A+ 万 )cos^( の sim(⑦) 、 第 4 項 - の (A+ 万 )sin( の cos( の cos⑦)cos( め ) 
是 由 地 球 自 转 引 起 的 惯性 力 分 量 ; 将 沿 速度 方向 的 惯性 力 分 量 视 为 为 附加 阻力 ,如 下 


A カ =- の (が 二戸)cos~( の sin( の + の (万 )sin( の cos( の cos(》)cos( め ) (5) 
定义 等 效 阻 力 为 D=D+AD ;将 公式 (3) ~~ (5) 代入 公式 (2) ,并 取 其 倒数 ,得 到 

dt _ Om 

dE VD (6) 


定义 纵向 升 阻 比 为 L/D=L/D, 其 中 Li 二 Leos (o) 是 升力 在 纵向 平面 内 的 分 量 ,规划 
L/D 为 

L/D= の だ +aE+a, (7) 

其 中 ao,al,a2 为 二 次 多 项 式 系数 ; 

现在 利用 L/D 剖面 估计 平稳 滑翔 状态 下 的 等 效 阻力 , 记 为 Dy :弹道 倾角 时 间 导 数 如 下 
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dy _ 1 ーー of (R, + H)c0s’ (f)c0(y) 


一 = 一 ろ _zcos の + 
dt VIm R (8) 


+ の :( +H)sin(¢) cos( の ) sin()cos()+2 ア の , cos( の sin( め ) | 


假设 Y 一 0 和 于 = 0 ,估算 平稳 滑翔 纵向 升力 ,如 下 


my* 
A+ 万 We ② 


其 中 , ALI 是 惯性 力 沿 垂 向 的 分 量 ,被 视 为 附加 纵 回 升力 ,公式 如 下 
AD ~ m[2V@, cos(sin(y) + 2 (R.+H)cos’ (内 ] (10) 
与 此 同时 ,采用 上 述 假设 , AD 也 被 简化 为 

AD= me (R, + H)sin(¢ cos(& cos(w) (11) 

則 の 。 由 下 式 佑 算 


人 


my 
mg 一 


人 a 
= の 。+AD っ OLAD = 和仁 
L/D L/D 


将 公式 (12) 代入 公式 (6) ,并 利用 E 蔡 换 V 得 到 
Fr  . 证 
dE 7 | 2E _ -AL+L/D.AD 


+AD (12) 


2E+ = ーg 
R+H| R,+H m 


由 于 H<<<Re, 故 令 H 取 滑翔 高 度 的 中 间 值 H ,进而 令 R 三 Re+H ;尽管 惯性 力 是 小 量 , 但 是 
当 速 度 接近 第 一 宇宙 速度 时 ,惯性 力 有 可 能 会 造成 上 式 分 母 为 零 , 从 而 发 生 奇异 ;为 了 避免 
发 生 上 述 奇异 情况 ,这 里 将 惯性 力 看 作 小 量 ,并 进行 一 阶 Taylor 展 开 , 如 下 
| 
に 
其 中 ,简化 符号 ha hn 的 定义 如 下 
_ だ (-AZ +L,/D AD) 


m 


(14) 


ん (15) 


ha 三 2ETu/RY (16) 

根据 AL 和 AD 的 表达 式 , 将 hz 分 为 两 个 部 分 hpsfl 和 hparz, 如 下 

hz1 一 hpAFI+hpPAF2 (17) 

其 中 ， 

hpari=-2R'V @ ecos (&) sin (Y) (18) 

hi = (R'@,) [-cos"( の +L,/Dsin( の cos( の cos( め の ] (19) 
由 于 hpsfz 的 影响 要 远 小 于 hpAfl, 因 此 ,采用 线性 函数 对 hpaf? 进 行 近似 ,如 下 
hparz (E) =kpar2 q) V+kpAFz (0) (20) 

其 中 , 系 数 kpazq) 和 kparz ぃ 由 两 个 端点 确定 ,如 下 
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ん なっ O = CD 
TAEM 
h(E) — ho (Ee ) 


其 中 ,hParz (B) 由 当前 状态 代入 公式 (19) 计算 得 到 ,而 hpar2 (Eragw 是 将 期 望 的 终端 状态 
代入 公式 (19) 计算 得 到 ; 

实际 上 , 高超 声速 滑翔 飞行 器 围绕 记 为 广义 亦 道 的 某 一 个 大 圆 飞 向 目标 ,飞行 器 围绕 
广义 亦 道 左右 横向 机 动 , 广 义 亦 道 的 方位 角 妆 看 作 是 飞行 器 航 回 角 的 某 种 加 权 平 均值 ， 
此 ,在 后 续航 向 角 曲 线 尚 且 未 知 的 情况 下 ,利用 广义 亦 道 的 方位 角 克 替 代 hparz (E) 和 hpar2 
(Eragw) 公式 中 的 航 向 角 : 全 此 , 在 公式 14) 中 ,除了 自 变 量 E 之 外 ,其 它 参 量 均 为 常 值 ,进而 
对 公式 (14) 进行 积分 ;经 推导 、 整 理 , 得 到 飞行 时 间 解 析 解 的 表达 式 如 下 : 


t(E,E)=k,(E-E,)+k, (VE +24/R’ -已 +2U/R ) 
ky |Gg -1/R RE +AIR -2E, LIR RE +24/R | 
k 


1 1 
一 一 一 一 -一 一 一 一 23 
2 と +// だ ーー (2 


ん 。 4 本 oR + Key In HR 
| 2E+L/R 2E,+ Lu/R 2E + Lu/R 
2E +21/R’ jj 5, +24/R’ -Va/R 

+k, In 
2E +21/R’ + ya/R: 5 +214/R’ + ya/R 
其 中 ,系数 kt 0) kto 、kt@ 、kt@ 、kt@) 、kt@ 、kt⑦ 的 表 送 式 如 下 


ーー 
ーー 
ー 


ルー 5 (24) 
ky 二 R'[a, i )a,] 外 = (25) 
だ の 
= C0) 
(koa + kpar2) R [CUAR Da -2a (4/R’)+4a] 
「 = 人 (27) 
が ん AF 2(C 1 * ヽ 2 ] 六 
Gs) ニー 7 が) (a パ ) の ムー っ 4(// パ )+ a (28) 


Ci + bn) [a - (// だ )a,] 


(29) 


ん 一 


k ,= [ 時 ん な の | だ [(// が ) a, 到 2a,(u/R’) +4a。] 是 R [al 一 (L/R )a Jpar20) (30) 


2u/R’ gfulR 4J// 
步骤 3 :考虑 多 禁 飞 区 和 抵达 时 间 约 束 的 解析 再 入 制导 方法 
此 步 针 对 单个 飞行 器 ,设计 考虑 多 禁 飞 区 和 抵达 时 间 约 束 的 再 入 制导 方法 ;根据 弹道 


4 
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特点 ,再 入 过 程 一 般 分 为 三 个 阶段 :下 降 段 . 平 稳 滑 翔 阶段 和 高 度 调整 阶段 ; 

S31: 下降 段 

为 了 避免 掉 进 稠密 大 气 层 而 引起 热流 密度 过 大 ,下 降 段 飞行 器 以 最 大 可 用 攻 角 、 零 倾 
侧 角 下 滑 ; 当 升力 足以 支撑 飞行 器 平稳 滑翔 时 , 攻 角 平滑 过 渡 到 基准 攻 角 ,随即 进入 平稳 滑 
翔 阶段 ; 

S32 :平稳 滑翔 阶段 

平稳 滑翔 阶段 是 最 长 .最 重要 、 也 是 最 复杂 的 再 入 飞行 阶段 ,此 阶段 的 制导 方案 利用 三 
维 再 入 弹道 解析 解 和 飞行 时 间 解 析 解 在 线 快速 规划 满足 禁 飞 区 和 抵达 时 间 约 束 的 参考 弹 
道 ; 

S33: 高 度 调整 阶段 

在 最 后 一 次 反 转 点 之 后 ,飞行 器 进入 高 度 调整 阶段 ,但 是 在 最 后 一 次 反 转 点 之 前 的 某 

个 节点 ,飞行 器 就 开始 了 高 度 调整 阶段 的 准备 工作 ;其 中 , 记 最 后 一 次 反 转 点 对 应 的 飞行 器 
能 量 为 Eggoro ,最 后 一 次 反 转 点 之 前 的 某 个 节点 记 为 对 应 的 飞行 器 能 量 为 Esr; 

设计 一 种 基于 在 线 弹 道 仿 真 的 多 目标 数值 迭代 规划 方案 ;在 此 方案 中 ,利用 方向 导数 
改进 了 拟 牛 顿 法 迭代 算法 ; 

当 E 三 Es 時 ,利用 所 述 的 基于 在 线 弹 道 仿 真 的 多 目标 数值 迭代 规划 方案 精确 微调 后 续 
轨迹 ,以 满足 终端 时 间 、 速 度 、 高 度 要 求 ; 当 Est>E>Epgor 时 ,考虑 多 禁 飞 区 约束 的 协同 解 
析 再 入 制导 方法 跟踪 在 迭代 规划 中 获得 的 纵向 升 阻 比 、 剩 余 飞行 距离 、 以 及 飞行 时 间 相 对 
能 量 的 参考 剖面 ,而 当 Esr (is 之 E 时 ,利用 比例 导 引 律 确定 基准 倾 侧 角 ,以 消除 航向 误差 ,并 
通过 微调 攻 角 跟踪 飞行 时 间 和 剩余 飞行 距离 参考 剖面 ,以 保证 满足 终端 时 间 和 速度 要 求 ; 

步骤 4: 多 飞行 器 抵达 时 间 协 同方 案 

假设 有 ney 个 飞行 器 , 记 为 HGVi ,ii 三 1,2,…,nHcv; 在 给 定 发 射 点 和 目标 点 之 后 ,根据 助 推 
火箭 性 能 和 所 选 主动 段 制导 方案 ,确定 飞行 器 的 再 入 段 起 始 状态 ;之 后 , 仅 根据 能 量 管理 要 
求 ,利用 纵 程 解析 解 确定 相应 的 纵向 升 阻 比 剖面 参数 ; 进而 ,利用 离线 弹道 仿真 预测 所 有 飞 
行 器 的 飞行 时 间 tfdevb ;i 二 1,2,… ,nnov; 从 中 选 出 时 间 最 长 的 一 个 飞行 时 间 tEr (waw) ,并 预 
留 发 射 准备 时 间 tpre 和 助 推 飞 行 时 间 tboost ,确定 期 望 的 抵达 时 间 tragy 二 tprettboostt+tEF max) ， 
进而 利用 traey-tEF (evi) 确定 各 个 飞行 器 的 再 入 段 起 始 时 间 ; 之 后 ,根据 所 选 的 助 推 段 制导 方 
法 ,确定 相应 的 发 射 时 间 。 

2. 根 据 权 利 要 求 1 所 述 的 一 种 考虑 多 禁 飞 区 约束 的 协同 解析 再 入 制 
于 :所 述 的 步骤 $S32 :平稳 滑翔 阶段 的 制导 流程 具体 如 下 : 

S321、 设 计 一 条 基准 攻 角 剖面 ,并 确定 相应 的 基准 升 阻 比 剖面 ; 

S322、 考 虑 能 量 管理 要 求 和 抵达 时 间 约 束 ,合理 设计 参数 化 的 纵向 升 阻 比 L/D 的 剖面 
同时 确定 参数 化 的 横向 升 阻 比 L,/D 的 剖面 

S323、 为 了 补偿 地 球 自转 的 影响 ,在 L/D 和 L,/D 剖面 的 基础 上 ,建立 等 效 纵 、 横 向 升 阻 
比 L/D 和 L,/D 的 剖面 

No 
析 解 求解 纵向 剖面 参数 ; 


rr 


导 方 法 ,其 特征 在 
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S325、 每 隔 60s ,利用 纵 程 解析 解 及 横 程 解析 解 根据 禁 飞 区 和 终端 位 置 约束 更 新 一 次 倾 
侧 反 转 序列 ; 

S326 .调节 基准 倾 侧 角 跟 踪 等 效 纵向 升 阻 比 剖 面 ,并 按 计 划 倾 侧 反 转 ; 

S327、 为 了 抑制 弹道 振荡 ,将 弹道 阻尼 反馈 引入 到 基准 攻 角 和 倾 侧 角 中 ,从 而 得 到 制导 
指令 ; 

S328、 按 照 过 程 约束 限制 倾 侧 角 指令 ; 

S329、 从 步骤 S322 开 始 重 复 上 述 过 程 ,直到 平稳 滑翔 阶段 结束 。 

3. 根 据 权利 要 求 1 所 述 的 一 种 考虑 多 禁 飞 区 约束 的 协同 解析 再 入 制导 方法 ,其 特征 在 

: 步 又 S33 中 所 述 的 基于 在 线 弹 道 仿 真 的 多 目标 数值 迭代 规划 方案 ,流程 具体 如 下 : 

S331、 利 用 弹道 仿真 预测 终端 时 间 和 终端 状态 ; 

S332、 判 断 终端 速度 或 终端 时 间 是 否 满足 要 求 ;若是 则 跳 转 步 又 S333, 否则 跳 转 步 又 
S334; 

S333、 根 据 终端 速度 和 终端 时 间 要 求 ,利用 拟 牛 顿 迭 代 法 调整 纵向 升 阻 比 训 面 和 最 后 
一 次 反 转 点 , 跳 转 步 又 S331; 

S334、 判 断 终 端 高 度 是 否 满足 要 求 ;若是 , 则 跳 转 步 又 S336, 否则 跳 转 步 又 S335; 

S335、 根 据 终端 高 度 误差 修正 基准 攻 角 参数 , 跳 转 步 又 5331; 

S336、 完 成 迭代 规划 。 


CN 109508030 B 说 明 书 1/23 页 
一 种 考虑 多 禁 飞 区 约束 的 协同 解析 再 入 制导 方法 
技术 领域 


[0001] ”本 发 明 涉及 一 种 考虑 多 禁 飞 区 约束 的 协同 解析 再 入 制导 方法 ,属于 航天 技术 、 武 
器 技术 、 制 导 控 制 领 域 。 


背景 技术 

[0002] ”协同 编队 飞行 技术 对 于 提升 体系 作战 效能 具有 重要 意义 ,拥有 广阔 的 应 用 前 景 ， 
目前 已 经 在 无 人 机 领域 得 到 了 广泛 而 深入 的 研究 .但 是 ,对 于 高 超声 速 滑翔 飞行 器 ,编队 飞 
行 十 分 困难 .因为 此 类 飞行 器 初速 很 高 ,但 无 动力 ,需要 通过 适当 的 横向 机 动 精确 管理 飞行 
能 量 。 但 对 于 具有 不 同 起 滑 状态 、 受 到 不 同 程度 干扰 的 飞行 器 ,其 速度 衰减 曲线 和 横向 机 动 
幅度 均 不 相同 ,因而 难以 组 成 相对 位 置 比较 稳定 的 飞行 编队 。 

[0003] ”在 协同 编队 飞行 技术 方面 ,常见 的 编队 形式 有 模 队 、 梯 队 、 横 队 、 纵 队 和 V 形 等 ,可 
以 实现 协同 侦察 防御 和 进攻 等 复杂 任务 ,此 外 ,通过 利用 领 机 产生 旋涡 中 的 上 升 气 流 , 编 
队 飞 行 还 可 以 有 效 节省 燃料 ,增加 航程 。 但 是 , 受 速度 和 横向 机 动 幅 度 的 时 变 特性 的 制约 ， 
目前 还 没有 可 以 有 效应 对 高 超声 速 滑 翔 飞行 器 协同 编队 飞行 问题 的 理论 和 方法 。 
[0004] Yu W. ,Chen W.,Analytical entry guidance for no-fly-zone avoidance ( 针 
对 禁 飞 区 规避 的 解析 再 入 制导 律 ) [JJAerospace Science and Technology,2018,72:426- 
442 .提出 了 具有 高 精度 的 地 球 旋转 补偿 模型 ,获得 了 性 能 更 好 的 三 维 再 入 弹道 解析 解 , 然 
后 基于 解析 解 设 计 了 渐 增 式 的 倾 侧 反 转 序列 规划 方案 ,实现 了 以 较 少 的 倾 侧 反 转 代价 应 对 
量 的 禁 飞 区 约束 的 目标 ,在 本 发 明 的 以 下 说 明 中 简称 为 文献 一 。 

[0005] Gaxley C.,Atmospheric entry (大 气 层 再 入 ) [M] .The RAND Corporation,1960. 
针对 固定 地 球 模型 ,给 出 了 常 值 纵 同 升 阻 比 条 件 下 的 飞行 时 间 解 析 解 ,在 本 发 明 的 以 下 说 
明 中 简称 为 文献 二 。 


发 明 内 容 

[0006] ”本 发 明 的 目的 是 为 了 解决 目前 还 没有 可 以 有 效应 对 高 超声 速 滑翔 飞行 器 协同 编 
队 飞 行 的 问题 ,提出 一 种 考虑 多 禁 飞 区 约束 的 协同 解析 再 入 制导 方法 ,解决 在 多 禁 飞 区 环 
境 中 导 引 多 个 高 超声 速 滑翔 飞行 器 同时 到 达 目 标的 协同 飞行 问题 。 

[0007] ”本 发 明 的 主要 内 容 分 为 三 个 方面 : (1) 针对 旋转 地 球 模型 ,推导 了 高 精度 的 飞行 时 
间 解 析 解 ; (2) 针对 单个 飞行 器 ,设计 了 考虑 多 禁 飞 区 和 抵达 时 间 约 束 的 解析 再 入 制导 方 
法 ; (3) 针对 多 个 飞行 器 ,设计 了 多 禁 飞 区 环境 中 叶 引 多 个 高 超声 速 滑翔 飞行 器 同时 到 达 目 
标的 协同 飞行 方案 。 其 中 ,在 解析 再 入 制导 方法 设计 时 ,控制 终端 速度 和 抵达 时 间 均 由 纵向 
升 阻 比 控制 ,因此 在 控制 上 是 一 个 多 驱动 问题 ,本文 利 用 纵 程 解析 解 和 时 间 解 析 解 设计 了 
一 种 能 够 兼顾 能 量 管理 要 求 和 抵达 时 间 要 求 的 纵 回 参考 剖面 规划 方法 ,可 以 有 效 解决 此 问 
题 。 

[0008] ”本 发 明 一 种 考虑 多 蔡 飞 区 约束 的 协同 解析 再 入 制导 方法 ,包括 以 下 几 个 步 又: 
[0009] ”步骤 1: 再 入 制 时 问题 描述 
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[0010] ”这 里 采用 圆 球形 旋转 地 球 下 的 三 维 再 入 质点 动力 学 模型 ,其 中 利用 经 度 和 纬度 中 
和 高 度 H 描 述 飞行 器 位 置信 息 ,而 用 速率 V、 弹 道 倾角 Y 和 航 向 角 ゅ 描 迷 速度 信息 。 

[0011] ” 极 高 的 飞行 速度 导致 力 热 环境 极其 恶劣 。 因 此 ,为 了 保证 飞行 器 的 各 个 子 系统 正 
常 工作 ,再 入 飞行 轨迹 需要 满足 热流 密度 0 、 来 流动 压 g、 过 载 n 约 束 。 考 虑 到 飞 控 系统 能 
有 限 ,需要 对 攻 角 和 倾 侧 角 范围 及 变化 率 进 行 限制 .除了 篆 规约 束 , 这 里 进一步 考虑 多 个 圆 
S 禁 飞 区 约束 。 
[0012] 再 入 段 飞 行 在 飞行 器 到 目标 的 水 平 距离 为 Sm 时 终止 。 此 时 期 望 的 终端 高 度 为 
Hragw, 终端 速度 为 Vrapt 终端 航向 误差 | A wmw| 和 终端 倾 侧 角 | orgy| 满足 约束 条 件 。 此 外 ,这 
里 还 指定 期 望 的 终端 时 刻 为 trapy。 

[0013] “步骤 2 :基于 旋转 地 球 模型 的 飞行 时 间 解 析 解 

[0014] ”为 了 应 对 抵达 时 间 约 束 ,这 里 推导 飞行 时 间 解 析 解 .能 量 定 义 如 下 


1 > ut 
一 [一 ] 
2 R.+H 0) 


L0016] 其 中 ,V 是 速度 ,H 是 高 度 ,Re 是 地 球 平 均 半 径 ,n 是 引力 常数 ,能 量 对 时 间 t 的 导数 为 
dE dy dH 


[0015] = 


由 (2) 
[0018] ” 式 中 g 为 重力 加 速度 ,在 旋转 地 球 背 景 下 ,有 如 下 复杂 的 非 线 性 方程 
[0019] 二 = ア sin( の ) G) 

dy 


[0020] = dr ーー —gsin(y)+ 0,(R, +H)cos "(の sin( の ) 了 


ー の (A+ 万 )sin( の cos( の cos(》)cos( め ) 
[0021] ”其 中 ,YY 是 弹道 倾角 ,D 是 阻力 ,m 是 质量 , wo 。 是 地 球 自 转角 速度 , 是 纬度 ,是 航 
向 角 。 公 式 (4) 中 右辺 第 3 項 ぷ (A+ 万 )cos"( の sin(⑦) ヽ 第 4 項 - が (A+ 万 )sim( の cos( の cos(⑦)cos( め ) 
是 由 地 球 自转 引起 的 惯性 力 分 量 ,本 文 将 沿 速度 方向 的 惯性 力 分 量 视 为 为 附加 阻力 ,如 下 


[0022] AD =-m@;(R, +H)cos ($)sin(y)+ mo; (R, +H)sin(¢) cos(¢) cos(y)cos(w) (5) 
[0023] ”定义 等 效 阻 力 为 D=D+AD 。 将 公式 (3) 一 05) 代入 公式 (2) ,并 取 其 倒数 ,可 得 

dt m 
[0024] 亚 =- 丙 (0) 


[0025] ”定义 纵向 升 阻 比 为 LAD = 五 1D ,其 中 Li 二 Leos (0) 是 升力 在 纵向 平面 内 的 分 量 , 规 
划 L/D 为 

[0026] L/D=%&E’ +aE+a, (7) 

[0027] ”其 中 a0,al,a2 为 二 次 多 项 式 系数 。 

[0028] ”现在 利用 L/D 剂 面 估计 平稳 滑翔 状态 下 的 等 效 阻 力 ( 记 为 Dyo) .弹道 倾角 时 间 导 
数 如 下 


dr _1 5 cos(7) 」 、 っ 
= デー -geos(y) + — +0;(R, +H)cos-(¢) cos(») 
[0029] dr 了 R+H (8) 


+ (R,+H)sin(g)cos(g)sin(y)cos(y) +2V 0, cos( の ) sin(w) | 
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[0030] 


[0031] 


[0032] 
[0033] 
[0034] 
[0035] 
[0036] 


[0037] 


[0038] 


[0039] 


[0040] 


假设 yx0 和光 <0 ,可 估算 平稳 滑翔 纵向 升力 ,如 下 


/ 


my* 
nso) < M8 一 RH -AL (9) 


其 中 ,ALi 是 惯性 力 沿 垂 向 的 分 量 ,被 视 为 附加 纵 同 升力 ,公式 如 下 
AL ~ ml2V@w, cos($)sin(y) +@;(R, + 万 )cos^( の ] (10) 
与 此 同时 ,采用 上 述 假设 , AD 也 可 以 被 简化 为 

AD = mo;(R, +H)sin(¢) cos(¢) cos(y) (11) 

则 Dss 可 以 由 下 式 估算 


+AD (12) 


将 公式 (12) 代入 公式 (6) , 井 利用 E 替 換 V 可 得 
du rp 
dE 2 | 2E -AD +L, /D.AD 


2E+ 一 一 8 十 
R+H| R+H m 


由 于 HR。, 故 可 令 H 取 滑翔 高 度 的 中 间 值 HF, 进 而 令 R* = 二 Ret+H”。 尽 管 惯 性 力 是 小 


(13) 


量 , 但 是 当 速 度 接近 第 一 宇宙 速度 时 ,惯性 力 有 可 能 会 造成 上 式 分 母 为 零 , 从 而 发 生 奇 异 。 


为 了 避免 发 生 上 述 奇 异 情况 ,这 里 将 惯性 力 看 作 小 量 , 并 进行 一 阶 Taylor 展 开 , 如 下 


[0041] 
[0042] 


[0043] 


[0044] 
[0045] 
[0046] 
[0047] 
[0048] 
[0049] 
[0050] 
如 下 

[0051] 
[0052] 


[0053] 


[0054] 


[0055] 


RD 区 (14) 
dE V2E +24/R° 
其 中 ,简化 符号 hai、hn 的 定义 如 下 
_R'(-AL +L,/D・A の ) 

m 
hn=2E+u/R* (16) 
根据 ALI 和 AD 的 表达 式 , 可 将 hz 分 为 两 个 部 分 hpaFrl 和 hpArz, 如 下 
hzl 一 hpAFI+hPAF2 (17) 


m m 


ん (15) 


其 中 ， 
hpari =-2R'V o 。cos( ゅ ) sin (⑩ (18) 
ん っ (だ の ) |ーcos"( の +L,/Dsim( の cos( の cos( め )] (19) 


由 于 hpAfz 的 影响 要 远 小 于 hpAfl, 因 此 ,可 以 粗略 地 采用 线性 函数 对 hpAf? 进 行 近似 ， 


hpar2 (E) Kpar2 (1) V+KPAF2 (0) (20) 
其 中 ,系数 kpar2a) 和 kpar2 0) 由 两 个 端点 确定 ,如 下 
へ ん な > (Zzz ) ど 5 ん な > (Erspy 


Kpap2t0) = アー ア (2 1) 
TAEM 
0 = の の ( ぢ ) で ん > (zz ) (22) 
アー gy/ 


其 中 ,hpAfz (E) 由 当前 状态 代入 公式 (19) 计算 得 到 ,而 hrarz (ErAgw 是 将 期 望 的 终端 
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状态 代入 公式 (19) 计算 得 到 。 

[0056] ”实际 上 ,高 超声 速 滑 翔 飞行 器 围绕 记 为 广义 赤道 的 某 一 个 大 圆 飞 向 目标 ,飞行 器 
围绕 广义 交道 左右 横向 机 动 ,广义 亦 道 的 方位 角 交 可 以 看 作 是 飞行 器 航向 角 的 某 种 加 权 平 
均值 ,因此 ,在 后 续航 向 角 曲 线 尚且 未 知 的 情况 下 ,本 发 明 利 用 广义 亦 道 的 方位 角 区 蔡 代 
hpar2 (E) 和 hPar2 (Eragw 公式 中 的 航 向 角 。 全 此 , 在 公式 4) 中 ,除了 自 变 量 E 之 外 ,其 它 参 量 均 


为 币值, 进而 可 以 对 公式 (14) 进行 积分 ,经 大 量 推导 、 整 理 ,可 得 飞行 时 间 解 析 解 的 表达 式 


如 下 
(AE.E,) =ko(E-E)+thko (V2E+24/R hE +2H/R ) 
Hi | CE-ARDV2E+2U/R —(2E, -4/R’) 2E, +24/R | 
| | 

tl R’ 2E,+ で | Cn 
了 / +H 

a E+24/R 2E, +24/R’ ,mf 2E+4/R 

| 2E+W/R’ 2E,+M/R’ E+ AL/R 


+ ん っ In ~ 人 が だ 2E, 十 2 7/ が " = Yu KR 
2E+21/R + ulR / 2E +2u/R + VA/R’ 
[0058] ”其 中 , 系数 kt 、kt@ ヽ kt 、kt の 、kt@ 、kt @ kt 的 表达 式 如 下 


(kpar + kpap2d) ) だ の 


[0059] ん = 1 1 
の ao か 

] 2 8 
[0061] ん 。= = 6) 
[0062] ん 。= A en 

Rk, 2(0 | 1 - 

10068 ks zs a 区 が の a (r/R )+a, | (28) 
[0064] ん た 。= EE 2 


i RO RO tl A as G0) 


2// が 8 が 4 R’ 
[0066] “步骤 3 :考虑 多 禁 飞 区 和 抵达 时 间 约 束 的 解析 再 入 制导 方法 
[0067] ”此 步 针 对 单个 飞行 器 ,设计 考虑 多 禁 飞 区 和 抵达 时 间 约 束 的 再 入 制导 方法 。 根 据 
弹道 特点 ,再 入 过 程 一 股 分 为 三 个 阶段 :下 降 段 .平稳 滑翔 阶段 和 高 度 调整 阶段 。 

[0068] ”S31: 下 降 段 

[0069] “为 了 避免 掉 进 稠密 大 气 层 而 引起 热流 密度 过 大 ,下 降 段 飞行 器 以 最 大 可 用 攻 角 、 
零 倾 侧 角 下 滑 。 当 升力 足以 支撑 飞行 器 平稳 滑翔 时 , 攻 角 平滑 过 渡 到 基准 攻 角 ,随即 进入 平 
稳 滑 翔 阶段 。 

[0070] ”S32: 平 稳 滑翔 阶段 


[0065] = [ 


10 
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[0071] 平稳 滑翔 阶段 是 最 长 .最 重要 、 也 是 最 复杂 的 再 入 飞行 阶段 ,此 阶段 的 制导 方案 利 
用 三 维 再 入 弹道 解析 解 和 飞行 时 间 解 析 解 在 线 快速 规划 满足 禁 飞 区 和 抵达 时 间 约 束 的 参 
考 弹 道 ,平衡 滑翔 阶段 的 制导 流程 设计 如 下 : 

[0072] ” S321、 设计 一 条 基准 攻 角 剖面 ,并 确定 相应 的 基准 升 阻 比 剂 面 ; 

[0073] ”S322、 考 虑 能 量 管理 要 求 和 抵达 时 间 约 束 , 合 理 设计 参数 化 的 纵向 升 阻 比 ( L/D ) 
剖面 ,同时 可 以 确定 参数 化 的 横向 升 阻 比 (L;/D ?剖面 ， 

[0074] “S323 为 了 补偿 地 球 自转 的 影响 ,在 L/D 和 L;/D 谢 面 的 基础 上 ,建立 等 效 纵 、 横 向 
井 阻 比 (L,/D 和 L。/D) 剖面 ; 

[0075] “”S324 按照 能 量 管理 和 抵达 时 间 要 求 ,利用 文献 一 中 的 纵 程 解析 解 和 所 述 步骤 2 得 
到 的 飞行 时 间 解 析 解 求解 纵向 剖面 参数 ; 

[0076] ”S325、 每 隔 60s ,利用 纵 程 解析 解 及 文献 一 中 的 横 程 解析 解 根据 禁 飞 区 和 终端 位 置 
约束 更 新 一 次 倾 侧 反 转 序列 。 
[0077] ”S326、 调 节 基 准 倾 侧 角 跟踪 等 效 纵向 升 阻 比 剖 面 ,并 按 计划 倾 侧 反 转 ; 

[0078] ”S327、 为 了 抑制 弹道 振荡 ,将 弹道 阻尼 反馈 引入 到 基准 攻 角 和 倾 侧 角 中 ,从 而 得 到 
制导 指令 。 

[0079] ”S328、 按 照 过 程 约束 限制 倾 侧 角 指令 ，; 

[0080] ”S329、 从 步骤 S322 开 始 重 复 上 述 过 程 , 直 到 平稳 滑翔 阶段 结束 。 

[0081] ”S33: 高 度 调整 阶段 

[0082] ”在 最 后 一 次 反 转 点 ( 记 此 节点 对 应 的 飞行 器 能 量 为 Ese rR) 之 后 ,飞行 器 进入 高 度 
调整 阶段 ,但 是 在 最 后 一 次 反 转 点 之 前 的 某 个 节点 ( 记 为 对 应 的 飞行 器 能 量 为 Es7) ,飞行 器 
就 开始 了 高 度 调 整 阶段 的 准备 工作 。 这 里 本 发 明 设计 了 一 种 基于 在 线 弹道 仿真 的 多 目标 数 
值 迭代 规划 方案 ,在 此 方案 中 ,利用 方向 导数 改进 了 拟 牛 顿 法 迭代 算法 ,从 而 减少 了 弹道 仿 
真 次 数 , 可 大 幅 提 高 迭代 收敛 速度 。 所 述 的 多 目标 数值 迭代 规划 方案 的 流程 为 : 

[0083] ”S331、 利 用 弹道 仿真 预测 终端 时 间 和 终端 状态 ; 

[0084] ” S332、 判断 终端 速度 或 终端 时 间 是 否 满足 要 求 ;若是 则 跳 转 步 又 S333 ,否则 跳 转 步 
又 5334; 
[0085] ” S333、 根据 终端 速度 和 终端 时 间 要 求 , 利 用 拟 牛 顿 迭 代 法 调整 纵向 升 阻 比 训 面 和 
最 后 一 次 反 转 点 , 跳 转 步 又 3331; 

[0086] ”S334、 判 断 终端 高 度 是 否 满 足 要 求 ; 若 是 , 则 跳 转 步 又 S336 ,否则 跳 转 步骤 S335 ; 
[0087] S335、 根据 终端 高 度 误差 修正 基准 攻 角 参数 , 跳 转 步 又 S331; 

[0088] ”S336、 完 成 迭代 规划 。 

[0089] ” 当 E 王 Esr 时 ,本 制导 方法 利用 此 多 目标 数值 迭代 规划 方案 规划 纵向 升 阻 比 、 剩 余 飞 
行距 离 、 以 及 飞行 时 间 相 对 能 量 的 参考 剖面 ,并 确 微调 后 续 轨 迹 , 以 满足 终端 时 间 、 速 度 、 高 
度 要 求 。 由 于 仅 需 要 对 后 续 一 小 段 弹道 进行 数 次 仿真 ,所 以 并 不 会 造成 较 大 的 计算 负担 。 当 
Est 之 E>>Esr tr® 时 ,本 制导 方法 跟踪 在 E==Est 时 刻 利用 多 目标 数值 迭代 方案 规划 获得 的 纵向 
升 阻 比 、 剩 余 飞 行距 离 、 以 及 飞行 时 间 相 对 能 量 的 参考 剖面 ,而 当 Esr arp 之 E 时 , 则 利用 比例 
导 引 律 确定 基准 倾 侧 角 ,以 消除 航向 误差 ,并 通过 微调 攻 角 跟踪 飞行 时 间 和 剩余 飞行 距离 
参考 剖面 ,以 保证 满足 终端 时 间 和 速度 要 求 。 
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[0090] ”步骤 4: 多 飞行 器 抵达 时 间 协 同方 案 

[0091] ”一 股 情 况 下 ,飞行 器 抵达 目的 地 的 时 间 受 两 个 重要 因素 影响 : 发 射 时 间 以 及 再 入 
飞行 过 程 中 对 时 间 的 控制 ,其 中 前 者 用 于 对 抵达 时 间 进 行 大 范围 调整 ,而 后 者 用 于 克服 干 
扰 ,对 时 间 进 行 精确 微调 。 但 是 ,由 于 本 发 明 并 不 考虑 助 推 段 和 下 压 段 的 飞行 过 程 , 在 这 里 
利用 再 入 段 的 起 始 时间 蔡 代 发 射 时 间 ,利用 再 入 段 的 终端 时 间 蔡 代 抵 达 时 间 。 在 实际 情况 
中 , 则 需要 综合 考虑 这 三 段 的 飞行 过 程 。 尽 管 助 推 过 程 中 的 不 确定 因素 会 引起 再 入 段 起 始 
时 刻 和 起 始 状态 的 偏差 ,但 是 利用 上 文 介 绍 的 制导 方法 可 以 在 再 入 飞行 中 有 效 克 服 这 些 偏 
差 因 素 。 
[0092] ”常见 的 时 间 协 同 问题 有 :同步 到 达 同 一 目标 ,异步 到 达 同 一 目标 ,同步 到 达 不 同 目 
标 , 异 步 到 达 不 同 目标 ,以 及 它们 之 间 的 组 合 问题 。 由 于 这 些 问 题 的 应 对 策略 类 似 , 下 面 以 
司 步 到 达 同 一 目标 的 问题 为 例 介绍 协同 方案 。 

[0093] ”假设 有 nsoy 个 飞行 器 , 记 为 HGVi,i 二 1,2,… ,nmev。 在 给 定 发射 点 和 目标 点 之 后 , 根 
据 助 推 火箭 性 能 和 所 选 主动 段 制导 方案 ,可 以 确定 飞行 器 的 再 入 段 起 始 状 态 。 之 后 , 仅 根据 
能 量 管理 要 求 ,利用 纵 程 解析 解 确定 相应 的 纵向 升 阻 比 剖 面 参数 。 进 而 ,利用 离线 弹道 仿真 
可 以 预测 所 有 飞行 器 的 飞行 时 间 tEF ev ,i 二 1,2,… ,ngev; 从 中 选 出 时 间 最 长 的 一 个 飞行 时 
间 tEF max) ,并 预 留 发 射 准 备 时 间 tpre 和 助 推 飞行 时 间 tpoost, 可 以 确定 期 望 的 抵达 时 间 trAg 王 
tpre+tboost+tEF max) ;进而 利用 traew-tEr qovi) 可 以 确定 各 个 飞行 器 的 再 入 段 起 始 时 间 。 之 后 , 根 
据 所 选 的 助 推 段 制 导 方 法 ,可 以 确定 相应 的 发 射 时 间 。 

[0094] ”本 发 明 的 优点 在 于 : 

[0095] (1) 发 明了 基于 旋转 地 球 模型 的 高 超声 速 滑翔 弹道 飞行 时 间 的 精确 解析 解 , 预 测 
误差 保持 在 3%% 以 内 ,可 适用 于 非常 值 纵向 升 阻 比 齐 面 的 情况 。 而 传统 的 预测 方法 由 于 未 考 
虑 地 球 旋转 的 影响 , 且 只 适用 于 常 值 纵向 升 阻 比 的 情况 ,误差 较 大 ; 

[0096] (2 可 基于 三 维 再 入 弹道 解析 解 和 飞行 时 间 解 析 解 ,在 线 快 速 规划 满足 禁 飞 区 、 抵 
达 时 间 、 终 端 能 量 等 多 约束 的 参考 弹道 ,解决 了 在 多 禁 飞 区 环境 中 导 引 多 个 高 超声 速 滑翔 
飞行 器 同时 到 达 目 标的 协同 飞行 问题 。 

[0097] (3) 设计 了 考虑 终端 时 间 、 速 度 和 高 度 要 求 的 基于 在 线 弹 道 仿 真 的 多 目标 数值 大 
代 规 划 方案 .同时 ,为 了 减轻 计算 负担 ,利用 方向 导数 改进 了 拟 牛 顿 法 ,减少 了 弹道 仿真 次 


附 图 说 明 

[0098] ”图 1 是 本 发 明 工 作 流 程 示意 图 ; 

[0099] ”图 2 是 基准 升 阻 比 剖面 曲线 ; 

[0100] ”图 3 是 高 度 调整 阶段 的 多 目标 数值 迭代 规划 方案 流程 图 ; 
[0101] ”图 4 是 飞行 器 轨迹 的 地 面 投影 ; 

[0102] ”图 5 是 飞行 器 的 高 度 -速度 曲线 ; 

[0103] ”图 6 是 飞行 器 的 攻 角 -时 间 曲 线 ; 

[0104] ”图 7 是 飞行 器 的 倾 侧 角 - 时 间 曲 线 ; 

[0105] ”图 8 是 飞行 器 的 剩余 飞行 距离 -能 量 曲 线 ; 

[0106] ”图 9 是 飞行 器 的 飞行 时 间 - 能 量 曲 线 。 


12 


CN 109508030 B 


[0107] ”图 10a、b 是 Monte 
[0108] ”图 l1a、b 是 Monte 
[0109] ”图 12a、b 是 Monte 
[0110] ”图 13a、b 是 Monte 
[0111] ”图 14a、b 是 Monte 
[0112] ”图 15a、b 是 Monte 
具体 实施 方式 

[0113] ”下面 将 结合 附 图 
[0114] 


标的 协同 飞行 方案 。 本 发 明 工作 流程 示意 图 
由 终端 速度 和 抵达 时 间 均 由 
用 纵 程 解析 解 和 时 间 解 析 解 设计 了 一 种 能 够 席 


控 1 


说 


明 书 


7/23 页 


Carlo 仿 真 的 飞行 器 再 入 轨迹 ; 


Car1lo 仿 真 的 飞行 器 高 度 - 速 度 曲线 ; 


Carlo 仿 真 的 飞行 器 攻 角 曲线 ; 
Carlo 仿 真 的 飞行 器 倾 侧 角 曲线 ; 


Carlo 仿 真 的 飞行 


器 终端 速度 和 终端 航向 误差 分 布 情况 ; 


Carlo 仿 真 的 飞行 器 到 达 时 间 分 布 1 


青 况 。 


和 实施 例 对 本 发 明 做 进一步 的 详细 说 明 。 


间 解 析 解 ; (2) 针对 单个 飞行 器 ,设计 了 考虑 多 禁 飞 区 和 抵达 时 间 约 束 的 解析 再 入 


本 发 明 的 主要 内 容 分 为 三 个 方面 : 4) 针对 旋转 地 球 模型 ,推导 了 高 精度 的 飞行 时 


胃 号 方 


法 ; (3) 针对 多 个 飞行 器 ,设计 了 多 茶 飞 区 环境 中 时 引 多 个 高 超声 速 请 翔 飞 行 器 同时 到 达 目 


1 所 示 , 其 中 ,在 解析 再 入 制导 方法 设计 时 ， 


如 医 


述 飞 行 器 位 置信 息 , 而 用 速率 V、 弹 道 倾角 y 和 航向 角 了 描 


考 剖 面 规划 方法 ,可 以 有 效 解决 此 问题 。 
[0115] ”整个 过 程 包括 以 下 几 个 步骤 : 
[0116] “步骤 1: 再 入 制导 问题 描述 
[0117] 

和 高 度 H 描 

[0118] 


や 
I 


极 高 的 飞行 速度 导致 力 热 环境 极其 恶劣 。 因 此 ,为 了 保 订 
工作 ,再 入 飞行 轨迹 需要 满足 热流 密度 0 、 来 流动 压 q、 过 载 n 约 束 。 考 虑 到 飞 控 系统 能 
有 限 , 需 要 对 攻 角 和 倾 侧 角 范围 及 变化 率 进行 限 


纵向 升 阻 比 控 


,因此 在 控 
lk 顾 能 量 管理 


由 上 是 一 个 欠 驱 动 问题 ,本 文 利 
要 求 和 抵达 时 间 要 求 的 纵向 参 


这 里 采用 圆 球形 旋转 地 球 下 的 三 维 再 入 质点 动力 学 模型 ,其 中 利用 经 度 入、 纬度 中 


述 速度 信息 。 
FE 飞行 器 的 各 个 子 系统 正 


所 。 除 了 常规 约束 ,这 里 进一步 考虑 多 个 圆 


形 禁 飞 区 约束 。 
L0119] 再 入 段 飞 行 在 飞行 器 到 目标 的 水 平 距离 为 Smapy 时 终止 ,此 时 期 望 的 终端 高 度 为 


Hragw, 终端 速度 为 Vraey, 终端 航向 误差 | A ramu| 和 终端 倾 侧 角 | oragw| 满足 约束 条 件 。 此 外 ,这 


里 还 指定 期 望 的 终端 时 刻 为 trAEy。 
[0120] “步骤 2: 基 于 旋转 地 球 模型 的 飞行 时 间 解 析 解 
[0121] ”为 了 应 对 抵达 时 间 约 束 ,这 里 推导 飞行 时 间 解 析 解 .能 量 定 义 如 下 
= こ = アニ = ニニ メ G1) 
10122 2 A+H 
[0123] ”其 中 ,V 是 速度 ,H 是 高 度 ,Re 是 地 球 平 均 半 径 ,u 是 引力 常数 .能量 对 时 间 t 的 导数 为 
dE ,dy ,dH 
[0124] Fi +g (32) 
[0125] ” 式 中 g 为 重力 加 速度 ,在 旋转 地 球 背 景 下 ,有 如 下 复杂 的 非 线 性 方程 
[0126] ーー sin( ア ) (33) 
dV D . 5 3 6 
[0127 三 有 (A+ 万 )cos~( の sm(》) G4 


-@;(R, +H)sin(¢) cos(¢) cos(») cos(w) 
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[0128] ”其 中 ,YY 是 弹道 倾角 ,D 是 阻力 ,m 是 质量 , o 。 是 地 球 自 转角 速度 ,由 是 纬度 ,是 航 
向 角 。 公 式 (4) 中 右辺 第 3 項 Z(A& + 万 )cos"( の sin(⑦) 、 第 4 項 -@( 人 A+ 万)sim( の cos( の cos(7)cos( め ) 
是 由 地 球 自 转 引 起 的 惯性 力 分 量 。 本 文 将 沿 速度 方向 的 惯性 力 分 量 视 为 为 附加 阻力 ,如 下 


[0129] AD =-m@; (R, +H)cos°($¢)sin(y) + mo (R, +H)sin(¢) cos( の cos(?)cos( め ) (35) 

[0130] “定义 等 效 阻力 为 万 =D+AD .将 公式 (33) 一 35) 代入 公式 (32) ,并 取 其 倒数 ,可 得 
dt m 

Lo (36) 


[0132] ”定义 纵向 升 阻 比 为 L/D=L/D ,其 中 Li 二 Leos (0) 是 升力 在 纵向 平面 内 的 分 量 ,并 
规划 纵向 升 阻 比如 下 ， 

[0133] L/D=wE?+aE+a, G7) 

[0134] ”其 中 ao,al,a2? 为 二 次 多 项 式 系数 。 

[0135] ”现在 利用 L/D 训 面 估计 平稳 滑翔 状态 下 的 等 效 阻力 ( 记 为 Dso) .弹道 倾角 时 间 导 
数 如 下 


IEI geos の ェ ー OO」 の 2 人 + 万 )cos^( の cos( ヵ ) 


[0136] dt Vim R +H (38) 
+e:( + 万 )sin( の cos( の sin( ア )cos( め )+2 ア の , cos( の sin( ゅ ) | 


[0137] ”假设 ~0 和 1 s0，, 可 估算 平稳 滑翔 纵向 升力 Liso ,如 下 


y? 
[0138] Licso) ~ mg — -AL (39) 
[0139] ”其 中 , ALi 是 惯性 力 沿 垂 向 的 分 量 , 被 视 为 附加 纵向 升力 ,公式 如 下 
[0140] AZ s m[2Ko@, cos(¢)sin(w) +@;(R, + 万 )cos^( の ] (40) 
[0141] 与 此 同时 ,采用 上 述 假设 ,AD 也 可 以 被 简化 为 
[0142] ”AD = mo;(R, + 万 )sin( の cos( の cos() (41) 
[0143] ” 则 平稳 滑翔 状态 下 的 等 效 阻力 Dss 可 以 由 下 式 估算 
my 
mg 一 -An 
MA Bs = Ds + AD= Go +AD= 一 +AD (42) 
L/D L/D 
[0145] ”将 公式 (42) 代入 公式 (36) , 井 利用 E 替 換 V 可 得 
区 ea の 
[0146] 9 ey 2 - 2E _ -Ah +L /DAD 
R+H|I R.+H m 


[0147] ”由 于 H<=<<Re。, 故 可 令 H 取 滑翔 高 度 的 中 间 值 了 ,进而 令 平均 地 心 距 R* 二 RetH 。 尽 管 
惯性 力 是 小 量 ,但 是 当 速 度 接近 第 一 宇宙 速度 时 ,惯性 力 有 可 能 会 造成 上 式 分 母 为 零 , 从 而 
发 生 奇异 .为 了 避免 发 生 上 述 奇 异 情况 ,这 里 将 惯性 力 看 作 小 量 , 并 进行 一 阶 Taylor 展 开 ， 
如 下 


R'L,/D 


dt 1 ん 
[0148] | + | 
dE 2E+24/R' [Lh 隐 


(44) 
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[0149] 
[0150] 


[0151] 
[0152] 
[0153] 
[0154] 
[0155] 
[0156] 
[0157] 
如 下 

[0158] 
[0159] 


[0160] 


[0161] 


[0162] 


其 中 ， 简 f 此 符号 hzi、hn 定义 如 下 
R'(-AL, +L/D.AD) 


h, = (45) 
hn=2E+u/R* (46) 
根据 AL 和 AD 的 表达 式 , 可 将 hz 分 为 两 个 部 分 hparl 和 hpArz, 如 下 
hzl 一 hpAFI+hPAF2 (47) 
其 中 ， 
hpAFl 一 -2RVwe。cos( 中 ) sin (由 ) (48) 
ん (だ の うーcos( の +L」/Dsin( の cos( の cos( め の ] (49) 


由 于 hpAfz 的 影响 要 远 小 于 hpAfl, 因 此 ,可 以 粗略 地 采用 线性 函数 对 hpAf? 进 行 近似 ， 


hpar2 (E) kpar2 (1) V+KPAF2 (0) (50) 

其 中 ,系数 kpar2 0) a go 由 两 个 端点 确定 ,如 下 

i 三 hpspa Er, TAEM アー hsp (EN TAEM (5 1) 
アー Vp 

pn (52) 


TAEM 


其 中 ,hparz (E) 由 当前 状态 代入 公式 (49) 计算 得 到 ,而 hparz (Eragw 是 将 期 望 的 终端 


状态 代入 公 \ 式 (49) 计算 得 到 。 


Es 


实际 上 ,高 超声 速 滑翔 飞行 器 围绕 记 为 广义 赤道 的 某 一 个 大 圆 飞 向 目标 ,飞行 器 


绕 广 义 赤 道 左 右 横 癌 机 动 ,广义 赤道 的 方位 角 W 可 以 看 作 是 飞行 器 航向 角 的 某 种 加 权 平 
因此 ,在 后 续航 向 角 曲 线 尚 且 未 知 的 情况 下 ,本 发 明 利 用 广义 亦 道 的 方位 角 克 替代 
hpar2 (E) 和 hpar2 (Eragw) 公式 中 的 航 向 角 。 全 此 , 在 公式 (44) 中 ,除了 和 上 自 变量 E 之 外 ,其 它 参 量 均 
为 常 值 ,进而 可 以 对 公式 (44 进行 积分 。 经 推导 可 得 飞行 时 间 解 析 解 的 表达 式 如 下 


[0164] 


[0165] 


[0166] 


[0167] 


1(E,E,)=k, (EE)+ko, (LE+24/R =r +24/R ) 
tha QE- LR RE +2LIR -2E, -4/R RE, +2/ が | 


1 1 
+ た | (53) 


2E+LU/R' 2E,+M/R’ 


PE+2U/R J2E, +2u/R’ 2E+L/R' 
填 た ル ん EE 


2E+A/R 2E, +u/R’ 2E, + 7/ が 


本 E22/R = a/R PE, +24/R’ — Ju/R 
™” (E+2A/R + RR | RE +24/R + pIR 
其 中 ,系数 kt 、kt@ 、kt@ 、kt の 、kt@) 、kt@ 、kt⑦ 的 表 送 式 如 下 
た pan + kpara )R a 
1) 
ka = Rla, 一 (// Ra] + だ の な oO 
6 2 8 


(54) 


(55) 
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[0168] 


[0169] 


[0170] 


[0171] 


[0172] 


[0173] 
一 所 示 。 
[0174] 
[0175] 


Ao。 
ko = ニー (56) 
ks (kpar + kn, )R ーー —2a (WR )+4a,] (57) 
ー が ん 。 "AF 2(0) /R [FR 58 
(5) 一 2 RR" ) (3 (4 ) da, -34 (x re ( ) 
所 = (psrl + ea [a ー(// だ )a,] (59) 
と 。 | 2 に [Co Ra -20 (ut/ RY) +4a0] Rla (HR)as Nps (60) 
2u/R SJu/R 4Ju/R 
本 发 明 的 飞行 时 间 解 析 解 与 传统 方法 及 数值 弹道 仿真 的 结果 对 比分 析 如 实施 例 


步骤 3 :考虑 多 禁 飞 区 和 抵达 时 间 约 束 的 解析 再 入 制导 方法 
此 步 针 对 单个 飞行 器 ,设计 考虑 多 禁 飞 区 和 抵达 时 间 约 束 的 再 入 制导 方法 。 根 据 


弹道 特点 ,再 入 过 程 一 股 分 为 三 个 阶段 :下 降 段 .平稳 请 翔 阶段 和 高 度 调 整 阶段 。 下 降 段 的 


台 高 度 较 高 ,大气 稀 薄 , 飞 行 器 快速 掉 高 。 在 平稳 清 翔 阶段 ,大 气 密度 适中 ,升力 足以 平衡 


重力 , 滑 


翔 高 度 平 组 下降。 得 益 于 高 升力 和 高 速度 ,飞行 器 在 此 阶段 的 滑翔 距离 可 达 上 万 公 


里 。 当 飞行 器 距离 目标 足够 近 时 ,进入 高 度 调 整 阶 段 。 此 时 飞行 器 通过 适当 调节 攻 角 来 获得 


期 望 飞行 高 度 。 相 比 于 之 前 的 制导 方法 (文献 一 ) ,这 里 主要 有 两 个 方面 的 改进 : (1) 根据 能 


量 管理 要 求 和 抵达 时 间 要 求 ,利用 飞行 时 间 解 析 解 和 纵 程 解析 解 改 进 了 参考 剖面 的 规划 方 
法 ; (2) 为 了 对 高 度 调整 阶段 的 轨迹 进行 精确 微调 ,根据 终端 时 间 、 速 度 , 高 度 约 束 , 设 计 了 


数值 迭代 规划 方案 以 及 相应 的 跟踪 策略 下面 步骤 4 一 6 详细 介绍 这 三 个 阶段 的 制导 方案 。 


[0176] 
[0177] 


步骤 4: 下 降 段 制导 方法 设计 
为 了 避免 掉 进 稠密 大 气 层 而 引起 热流 密度 过 大 ,下 降 段 飞行 器 以 最 大 可 用 攻 角 、 


零 倾 侧 角 下 滑 。 当 升力 足以 支撑 飞行 器 平稳 滑翔 时 , 攻 角 平滑 过 渡 到 基准 攻 角 ,随即 进入 平 
稳 滑翔 阶段 。 


[0178] 
[0179] 


步骤 5: 平 稳 滑 翔 阶段 制导 方法 设计 
平稳 滑翔 阶段 是 最 长 .最 重要 、 也 是 最 复杂 的 再 入 飞行 阶段 ,此 阶段 的 制导 方案 利 


用 三 维 再 入 弹道 解析 解 和 飞行 时 间 解 析 解 在 线 快 速 规划 满足 禁 飞 区 和 抵达 时 间 约 束 的 参 
考 弹 道 , 平 衡 滑翔 阶段 的 制导 流程 如 下 : 


[0180] 
[0181] 


$51 设 计 一 条 基准 攻 角 剖面 ,并 确定 相应 的 基准 升 阻 比 剖 面 ; 
S52 考虑 能 量 管理 要 求 和 抵达 时 间 约 束 ,合理 设计 参数 化 的 纵向 升 阻 比 (L/D ) 剖 


面 ,同时 可 以 确定 参数 化 的 横向 升 阻 比 (L/D ) 剂 面 


[0182] 


S53 为 了 补偿 地 球 自转 的 影响 ， 在 历 和 记 而 浊 面 的 基础 上 ， 建立 等 效 纵 、 横 向 升 


阻 比 (L,/D 和 L。/D) 剖面 ; 


[0183] 


S54 按照 能 量 管理 和 抵达 时 间 要 求 , 利 用 文献 一 中 的 纵 程 解析 解 和 所 述 步骤 2 得 到 


的 飞行 时 间 解 析 解 求解 纵 问 剖面 参数 ; 


[0184] 


S55 每 隔 60s ,利用 纵 程 解析 解 以 及 文献 一 中 的 模 程 解析 解 根据 禁 飞 区 和 终端 位 置 
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约束 更 新 一 次 倾 侧 反 转 序列 。 
[0185] ”S56 调节 基准 倾 侧 角 跟踪 等 效 纵 癌 升 阻 比 神 面 ,并 按 计 划 倾 侧 反 转 ; 
[0186] ”S57 为 了 抑制 弹道 振荡 ,将 弹道 阻尼 反馈 引入 到 基准 攻 角 和 倾 侧 角 中 ,从 而 得 到 制 
导 指令 。 
[0187] ”S58 按照 过 程 约束 限制 倾 侧 角 指令 ; 
[0188] ”S59 从 步骤 S52 开始 重复 上 述 过 程 ,直到 平稳 滑翔 阶段 结束 。 
[0189] 1) 基准 攻 角 和 基准 升 阻 比 
[0190] ”为 了 发 挥 飞行 器 最 大 能 力 ,采取 如 下 基准 攻 角 abs 剂 面 
O0 Ez>E, 


[0191] C= EE Y 
テー な (の 。 一 の ) 二 呈 ) E<E, 


(61) 


x Ea 


[0192] ”其 中 ,Es 二 -5.55X10'J/kg 位 于 平稳 滑翔 和 高 度 调整 阶段 的 交 班 点 附近 。Ereu 是 再 
入 段 期 望 的 终端 能 量 。ai=10 为 升 阻 比 最 大 时 的 攻 角 值 。 在 高 度 调 整 阶段 ,为 了 获得 期 望 
的 终端 高 度 , 将 基准 攻 角 逐渐 减 小 至 攻 角 az。 这 里 ,a? 被 初步 设置 为 6" ,并 在 进入 高 度 调整 阶 
段 前 会 对 其 进行 精确 微调 .为 了 在 大 干扰 情况 下 维持 滑翔 ,人 为 限制 absl 之 5” ,与 基准 攻 角 
absl 对 应 的 基准 升 阻 比 L/D， 痢 面 如 图 2 所 示 。 

[0193] (2) 改进 参考 剖面 

[0194] ”由 于 飞行 能 量 管理 和 抵达 时 间 控 制 相 互 耦合 、 相 互 制约 , 仅 利 用 纵 癌 升 阻 比 章 面 
控制 终端 能 量 和 时 间 并 不 容易 .经 大 量 探索 ,本 发 明 发 现 如 下 形式 的 纵向 升 阻 比 剖 面 
L/D(x; ) 可 以 在 保证 满足 终端 能 量 要 求 的 前 提 下 ,实现 对 抵达 时 间 的 有 效 调节 。 
L, DE fa (Xa) +L MDE, fp (xs) XoE, 

fin Xa)L DE 一 DE,)+L, DCE,) x; <E, 

[0196] ”其 中 ,E 代 表 当 前 时 刻 的 能 量 ,xz 代 表 任 意 时 刻 的 能 量 。 函 数 fiijp( (xg) 、fri/p ⑦ 
(xE) 、frip@) (XB) 的 定义 如 下 


(62) 


[0195] L/D(x;) 1 


1 
fiina (Xe) = E-E, 72 アール と 


[0197] iipo)(Yz) = 


E-E, 


Ex Y 
fu py (Xs) 一 | E, 一 已 | 


TAEM 


[0198] L,/D( ぢ ) 、 L, DE, 和 LI7D(BEo) 是 三 个 能 量 节点 对 应 的 纵向 升 阻 比 ,也 是 剖面 的 
三 个 参数 ,其 中 ,前 两 个 参数 用 于 管理 能 量 并 控制 飞行 时 间 ,在 下 文中 会 利用 解析 解 进行 求 
解 。 为 了 使 得 倾 侧 角 最 终 收 敛 到 零 , 令 第 三 个 参数 LI/DCBEar)= 厂 pDLDvCErar) ) 其 中 , 
L/D(CEay) 是 期 望 终端 状态 对 应 的 理想 升 阻 比 ,系数 后 p =LD, (ELD, (用 于 粗略 补 

党 气 动 拉 偏 的 影响 ,LUD，,( 相 是 利用 气动 辨识 技术 获得 的 当前 实际 升 阻 比 ,而 CD，,( 可 是 
当前 状态 对 应 的 理想 升 阻 比 。 在 下 文中 , 当 不 特 指 某 一 能 量 节 点 对 应 的 函数 值 时 ,为 方便 起 
见 省 去 自 变量 的 书写 ,如 L/D(x;) 简 写 为 Li/D 。 
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[0199] ”在 确定 基准 升 阻 比 痢 面 和 纵向 升 阻 比 剖面 之 后 ,可 以 由 几何 关系 确定 参数 化 的 横 
向 升 阻 比 剖 面 L,D ,如 下 

[0200] L,/D=(-1D“ sgn |L。/D| (64) 

[0201] ”其 中 ,nr 是 已 经 发 生 的 反 转 次 数 ,sgn 是 符号 函数 ,用 于 确定 飞行 器 的 初始 倾 侧 方 
向 ,L/D| 是 L,/D 的 模 值 ,由 下 式 估算 

[0202] |L,/D|=YG ,LD,,) -(L,/D)* (65) 

[0203] “为 了 补偿 地 球 自转 的 影响 ,将 惯性 力 与 气动 力 组 合 为 等 效 气 动力 .通过 合理 分 析 
惯性 力 的 变化 规律 ,在 上 述 L/D 和 L,/D 训 面 的 基础 上 ,可 以 建立 如 下 反比 例 函 数组 合 形 式 
的 等 效 纵向 升 阻 比 剖 面 L/D 、 横 向 電 阻 比 割 面 L.D 。 


[ 


[0204] L/D=L,/D(1+4 + ん ) (66) 
[0205] LL,/D=L,/DO+h, +hh)tL /DO +hnh,) (67) 
[0206] ”这 里 ， 
ヵ ヵ 。 h h 
0207] = 王 、 ム =ー テ ん = ニー ムカ = 68 
1 ん, < h, h, に h, ( ) 


[0208] ”其 中 ,hn 如 公式 (46) 所 示 ,h; ， 所 ,， 刀 ;和 及 ,是 一 些 复杂 的 惯性 力 组 合 项 的 近似 公 
式 ,如 下 

h(E) = ki + koE 

h(E) = ka + aE 
h(E)=h0 + ho Et hE 
h(E)=ka0 + kawE 

[0210] ”近似 公式 的 系数 kpi (0) khld 、kns の 、kKh2a)、kKn3(0) 、khs 4) 、kns ② khokh0 由 当前 状 
态 和 期 望 的 终端 状态 确定 ,计算 方法 如 下 。 

[0211] 1) 计算 系数 kh1(0) 和 kni 0) 

ん (と ルーム (と h(E) —-h, (Er) 


[0209] 1 (69) 


ー TAEM ん 。 ニー いて 2 3 一 THEM 70 

[0212] io E— Er 2 E— Erey | 

[0213] ”其 中 

[0214] h(E) =-2R Vo, cos( の sin( の - が eK + H)cos(p)| cos(h) -L/D™ sin(p)oos(P)| (71) 


hh Cra) = 2R Vn @, COS( み の ) SINW apny ) — が が (R, + Hr )coS( み 4 ) x 
| cos(Grsau LD Sin( 办 war ) COS VW rigs )| 

[0216] “LVDz 是 上 一 制导 周期 获得 的 当前 纵向 升 阻 比 ,是 期 望 的 终端 升 阻 比 , b rap 是 目 

标的 纬度 ,是 飞行 器 的 广义 赤道 方位 角 航 向 角 ,wz 是 飞行 器 的 广义 赤道 方位 角 航 向 角 

在 终点 处 的 值 。 


[0217] 2) 计算 系数 khz( 和 khz 0) 


ん 。 Era ) を > ん 。 (を Er k = ん 。 (と ) h,, Era ) (73) 
p21) 一 
Eh= Er 


£- Er 


[0215] (72) 


[0218] ん >) = 
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[0219] 
[0220] 
[0221] 
[0222] 


[0223] 


[0224] 


[0225] 
[0226] 
[0227] 


[0228] 
[0229] 
[0230] 
[0231] 
[0232] 


其 中 ， 

ん 。() = oR (R, +H)L /DY™™ sin( の cos( の cos( め ) (74) 

h., (Ersaey ) = @; が (LDSm( み の, ) Cos(Wraeu ) COSCDr iy ) (75) 

3) 计算 系数 kn3 (0) 、kns @ 和 khs @ 

ky0, ニー ク 2 の. ーー Smn( み と Sm( の ルル | (76) 

(E — Er ) 
[pr SIN(G) +V sin(Grspr ME + Erspy) 
(E Er ) 

の SMD na )E +V sin(f) Er 
(E Em ) 

(VM sin(@) —sin( Gr )] (78) 
(な 一 Er が 

4) 计算 系数 kha 和 kra a) 


h(E E—h,(E)E,,. h(E) hE 
4( oa - 4 ( ) TAEM Ran 到 aC ) st TAEM ) (79) 
B= Er B= Er 


ka = 2 み だ 


(77) 
+4 の が" 


ん 。。) ニー2 の だ 


ん 4o) > 


其 中 

h(E)=-2R VO, cos(f)sin(y)—R の (A+ 万 )cos( の cos( の (80) 

ha Br) = 2R Visgy COS(bragyy ) INP rig) — Ro (R, + Hrsgy )cos( み 4 )COs( Gras) (81) 
(3) 纵 回 剖面 参数 解 算 

这 里 ,本 发 明 根据 能 量 管理 和 抵达 时 间 要 求 ,利用 纵 程 解析 解 和 飞行 时 间 解 析 解 


来 确定 公 


| 


[0233] 


[0234] 


[0235] 


节点 E0 到 能 


[0236] 


[0237] 


[0238] 


\ 式 (62) 中 的 参数 L/D(E) 和 L/D(E,)。 

记 和 A 为 一 股 形式 的 纵向 升 阻 比 多 项 式 , 即 公式 (37) 的 系数 数组 ,如 下 

A= (82) 

则 利用 文献 一 中 的 纵 程 解析 解 公 式 , 可 得 在 此 纵向 升 阻 比 控制 下 ,飞行 器 从 能 量 
E 量 节点 BE 的 纵 程 为 


1 
Xp(E,E,,A) = Cr kia + 可 名 ok wo og A) 


| 1 1 
| E | Ju | yo| を | ko HR (83) 


A A 
| hw -hw | hone - IR* ee bE, ,A) 
其 中 , 緒 数 f。 (1) (E, Eo, A) ,fxD (2) (E, Eo, A 和 和 fxp (9) (E, Eo, A) 的 定义 如 下 


R A 
一 (ai ———-4,)\(E-E, 
> ( 1 2 が * 。)( 0) 


、 Ra, 
fp (CE,E,,A) の ロ 


が 2 2E+ // a 
十 一 去 | さこ | ーー グー ーー 
PT うみ 2E, +u/R 
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.pa (EFA)= 区 (E-E,)+ Es だ | 
se RR EAR 
[0239] a 
医 a od, +a, ] | 
区 2E+AL/R’ 2E,+u/R' 
到 人 2BE+H/R R 
fp (Es Eo ,A) 8 Wem +A/R’ 上 EE R* 国民 去 二 元 | 
[0240] 本 


| ee [| 
41U2 ダ が リー 2R* YY "| QETWR) QE, + ER)’ 
[0241] 。 记 A1、A2、A3 和 A4 分 别 为 与 公式 (62) - (63) 相关 的 多 项 式 系数 数组 ,如 下 


0 0 | 0 
.A。 = 0 (87) 
1 


2E, 
E, 
[0243] ” 则 针对 公式 (62) 所 示 的 纵向 升 阻 比 剖 面 ,可 预测 终端 纵 程 为 
xp En E)=L /DCE CE,,E,A,) +L, DCE, (EB,,E,A,) (88) 
HL /Dg LI /DE, kp Forgas Es As)+L /DE, rp (Erg E,, A) 

[0245] ”同时 ,针对 公式 (62) 所 示 的 纵向 升 阻 比 剖面 ,利用 公式 (53) 可 预测 终端 时 间 如 下 
(Es E)=L DCEY(CE,,E,A,)+L, /DE YE,,E, A,) (89) 
+[L /DE ) = DL /DE (Erg Es A tT DE Yn Bas A) 

[0247] “ 则 公式 (62) 中 的 参数 L/D(E) 和 L/D(E,) 可 以 通过 求解 如 下 二 元 一 次 方程 组 获得 

p(BrsusE)= S$ — rap 
ee 了 
[0249] ”其 中 ,sgo 是 剩余 飞行 距离 ,trAg 期 望 的 抵达 时 间 。 
[0250] 但 一 方面 受 限于 能 量 管理 要 求 的 制约 , 另 一 方面 未 能 充分 考虑 横向 机 动 的 影响 ， 
方程 组 (90) 的 解 会 引起 倾 侧 角 大 幅 振荡 ,妨碍 禁 飞 区 规避 ,不 利于 实际 应 用 .因此 ,本 发 明 
提出 通过 大 幅 调 整 纵向 升 阻 比 剖面 来 克服 由 横向 机 动 引起 的 时 间 偏 差 。 经 探索 ,对 纵向 升 
阻 比 剖 面 参 数 进行 修正 , 令 
[LIDE) =L,/D, (CE) +L,/D, CE) 
LDCE,) =L,/D,(E,)+L,/D,(E,) 
[0252] ”其 中 ,L/Di(Z2) 和 L/Di(E,) 是 理想 情况 下 标 称 轨迹 对 应 的 纵向 剖面 参数 , L/D,(E) 
和 L/D,(E,) 则 是 根据 实际 情况 需要 进行 修正 的 参数 ,将 公式 (91) 代入 (88) 和 (89) ,并 整理 
可 得 


| 


0242] A,= | 
[ ] 1 (E, Er だ 


ィ 
12 3 


[0244] 


[0246] 


[0248] (90) 


[0251] (91) 


Xp (Er E) = Xp (Eraeys E)+ Ap (Er E) 
HEE) = to Era E)+ At(Erseu, E) 


[0253] | (92) 


[0254] ”其 中 ,xpesD (BTagw,E) 和 t (ETAgw,E) 是 标 称 轨 迹 对 应 的 部 分 ,而 A xp (Bagw,E) 和 At 
(Erapy, E) 则 是 对 实际 情况 的 修正 ,公式 如 下 
Xp (Pry: £)= L/D, (Ep (Es,E,A)T+TL/D (EE, h(E,,E,A,) 

+[L DO) -L/D CE, Po Ee EA +L DO を し A,) 


[0255] (93) 
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de Ax (Frais E)=L,/D, (Ex (E,,E,A)+L /DE, XE,.E, A,) (94) 
-L/D,(E, x (Es Es,As)+L /D,(E, x (Ey, E,,A) 
ton (ErasE)=L /DEY(E,,E,A)+L /DE YE,,E,A,) 
HL ELD (Es Es A +L /ID CE ME nn EA) 
pe At(EsE)=L, /DEY(E,,E.A)+L /D,(E, YX(E,.E,A,) (96) 
-LDO Je Es As)+L ID CE, Ys bsA) 
[0259] 标 称 情况 下 ,L/D,(E) 与 L/D,(E,) 应 使 飞行 器 的 纵 程 满足 终端 约束 , 即 
[0260] xpe。j) (Brapy, E) 一 Sgo-STAEM (97) 
[0261] 。 则 令 L/Di(82)=L/Di(E,) ,将 公式 (93) 代入 公式 (97) 可 解 得 
-Sn LD x (Es BE,,A,) 


(95) 


[0257] 


ーー S 7 ン 
[0262] L,/D,(E)=L,/D, (FE A i i ht es 98 
; い 、 の xp(Es,E,Al+A,)+xp (En Eo, As — A,) : ) 
[0263] ”注意 ,上 式 分 母 中 的 表达 式 利用 了 如 下 的 积分 性 质 
[0264] > (EE,Al+A,)=x,(E,,E,A)+x, (EF,,E,A,) (99) 
Xp (Erspm Eas A 去 A,) =Xp (の ん) ー や っ (as 作っ) 


[0265] ” 另 一 方面 ,L/D;,(E) 和 L/D,(E,) 用 于 消除 终端 时 间 误 差 Atr, 但 不 能 引起 附加 航 
程 ,利用 公式 (94) 和 (96) 可 得 


Axp (と BE)=0 
[0266] | (100) 
At(Erypy ,E)= ーAZ。 
[0267] 和解 得 
Li/D。( ぢ ) ーー (E,,E,A,)+ i EA — A;) At, 
[0268] 本 1 (101) 
L/D,(E,)= Eb AY 


[0269] ”其 中 , 简 记 符号 Do 的 表达 如 下 

D, =1(E,,E,A [x (BE,,E,A,)— x (Es EA) + (EE,,A,)] 

x (E,,E,A)(E,,E,A,) -i(E,E,,A)+t(E,,,E,,A)] 

[0271] ”为 了 预测 终端 时 间 误 差 A tr, 需 要 事先 离线 规划 标 称 弹道 , 并 获得 两 个 参考 剖面 ， 
即 射程 剖面 ssoceo (E) 和 时 间 剖 面 ter) (B) ,其 中 , 标 称 弹道 的 纵向 升 阻 比 剖 面 仅 根 据 能 量 
管理 要 求 确定 ,而 终端 时 间 则 由 发 射 时 间 控 制 ,但 实际 情况 的 剖面 可 能 是 sgo (EB) 和 t (E) 。 
此 预测 终端 时 间 误 差 A tf 的 第 一 个 组 成 部 分 是 A tr 二 t (BE) -t cep) (E) ,第 二 个 组 成 部 分 则 
是 由 航程 误差 As。。 三 s。。 (BE) -ssocep (BE) 引起 的 A tr (2) 。 现 在 推导 在 基准 控制 下 由 A sso 引 起 
的 时 间 误 差 A tr ,将 公式 (98) 代入 公式 (95) 可 得 


HUE,,E,A, +A,) +E E,.A, — A,) 
ton Era の) ニー 
XE,,E,A, A,) Xp Braus La: A A,) 

1(E,,E,A, + A + En EA A) —— 
[0272] = ( 4 1 2) ( TAEM 4 3) L, DE Err Es, As) (103) 
YE,,E,A; A,) Xp (Eragus Las As —A,) 
+L, DE WE > E, > A,) 


[0273] 利用 差分 公式 可 得 由 A sgo 引 起 的 时 间 误 差 A tr 


[0270] (102) 


四 


[一 Srapx | 
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HE, EA +A) + E,,A,—A,) 
(EEA + A ) tx EE AA) 2 
[0275] ”至 此 ,完成 了 纵向 剖面 参数 解 算 工作 。 
[0276] (4) 倾 侧 反 转 序列 规划 
[0277] ”由 于 高 超声 速 滑翔 飞行 器 主要 通过 调整 倾 侧 角 模 值 跟踪 纵向 参考 剖面 ,所 以 在 确 
定 纵向 升 阻 比 剖面 之 后 , 倾 侧 角 模 值 剖面 基本 确定 。 因 此 ,飞行 器 仅 能 通过 适时 改变 倾 侧 方 
向 控制 横向 机 动 , 以 便 规 避 禁 飞 区 域 并 最 终 抵 达 目 标 . 本 发 明 采 用 解析 迭代 方案 规划 倾 侧 
反 转 序列 。 由 于 优先 调整 已 有 反 转 点 应 对 禁 飞 区 约束 ,此 策略 所 需 反 转 次 数 较 少 ,可 充分 发 
挥 飞行 器 的 横向 机 动能 力 , 应 对 大 量 禁 飞 区 约束 .下面 介 绍 策略 流程 。 
[0278] 1) 为 了 抗 干扰 ,人 为 扩大 所 有 禁 飞 区 半径 ,从 而 使 得 与 真实 禁 飞 区 边界 之 
间 保 留 一 个 安全 距离 .考虑 到 弹道 误差 的 累积 效应 ,这 里 将 半径 增 量 设置 为 关于 飞行 器 到 
禁 飞 区 距离 的 线性 函数 ,并且 会 随 着 飞行 器 接近 目标 而 逐渐 减 小 ; 
[0279] 2) 仅 根 据 终端 位 置 约束 ,利用 横 程 解析 解 规划 两 个 反 转 点 ; 
[0280] 3) 从 最 近 禁 飞 区 开始 ,利用 解析 解 搜寻 距离 禁 飞 区 最 近 的 航 迹 点 ,以 判断 该 禁 飞 
区 约束 是 否 得 到 满足 。 如 果 是 , 则 继续 判断 下 一 个 禁 飞 区 ,否则 ,执行 人 ; 
[0281] 4) 判断 该 禁 飞 区 是 位 于 倒数 第 二 个 反 转 点 之 前 、 最 后 两 个 反 转 点 之 间 、 还 是 最 后 
一 次 反 转 点 之 后 .如果 是 位 于 倒数 第 二 个 反 转 点 之 前 , 则 执行 5) ;如 果 是 位 于 最 后 两 个 反 转 
点 之 间 , 则 执行 6) ;如 果 是 位 于 最 后 一 次 反 转 点 之 后 , 则 执行 7) ; 
[0282] 5) 如果 此 禁 飞 区 位 于 倒数 第 三 次 反 转 点 之 前 , 则 表明 此 禁 飞 区 距离 终点 较 远 , 因 
此 可 以 不 考虑 终端 位 置 约束 。 这 里 先 利 用 禁 飞 区 规避 策略 调整 反 转 点 ,应 对 当前 的 禁 飞 区 
约束 ,然后 利用 终端 横 程 控制 策略 1 调整 后 续 反 转 点 ,以 保证 满足 终端 位 置 要 求 。 跳 转 执行 
8) .下 文中 会 对 禁 飞 区 规避 策略 终端 横 程控 制 策略 1 以 及 6) 中 的 终端 横 程控 制 策略 2 进行 
说 明 ; 
[0283] 6) 如 果 禁 飞 区 位 于 最 后 两 次 反 转 点 之 间 ,此 时 规划 倾 侧 反 转 序列 需要 兼顾 禁 飞 区 
约束 和 终端 位 置 要 求 。 这 里 同样 首先 利用 禁 飞 区 规避 策略 应 对 禁 飞 区 约束 ,但 是 由 于 此 时 
距离 目标 较 近 ,之 后 会 采用 终端 模 程 控制 策略 2 规划 后 续 反 转 点 ,以 满足 终端 横 程 要 求 。 跳 
转 执 行 8) ; 
[0284] 7) 如 果 禁 飞 区 位 于 最 后 一 次 反 转 点 之 后 ,由 于 禁 飞 区 距离 终点 太 近 ,这 里 忽略 此 
禁 飞 区 约束 ,并 保留 原 有 有 反 转 点 序列 , 跳 转 执行 8) ; 
[0285] 8) 确定 下 一 个 禁 飞 区 , 回 到 3) 继续 判断 禁 飞 区 约束 是 否 得 到 满足 ,直到 检测 完 所 
有 禁 飞 区 约束 。 
[0286] “下面 说 明 禁 飞 区 规避 策略 终端 横 程 控制 策略 1 和 终端 横 程 控制 策略 2 的 原理 。 
[0287] 1) 禁 飞 区 规避 策略 
[0288] ”此 策略 分 两 种 情况 应 对 禁 飞 区 约束 :当前 禁 飞 区 位 于 倒数 第 二 次 反 转 点 之 前 ; 当 
前 禁 飞 区 约束 位 于 最 后 两 次 反 转 点 之 间 。 
[0289] ”在 第 一 种 情况 中 ,由 于 距离 目标 较 远 ,在 处 理 当 前 禁 飞 区 约束 的 过 程 中 无 需 考虑 
终端 位 置 约 束 。 本 发 明 利 用 解析 解 优 先 调整 已 有 反 转 点 ,以 使 得 飞行 器 从 靠近 禁 飞 区 的 一 
侧 绕 过 禁 飞 区 。 如 果 不 成 功 , 则 进一步 尝试 从 禁 飞 区 的 另 一 侧 绕 过 去 ,或 者 新 增 一 个 反 转 点 
应 对 禁 飞 区 约束 。 在 成 功 规避 当前 禁 飞 区 之 后 ,由 于 反 转 序列 调整 会 改变 之 前 的 轨迹 ,所 以 


[0274] Alyron 一 (104) 


22 


CN 109508030 B 说 明 书 17/23 页 


需要 检查 之 前 的 禁 飞 区 约束 是 否 仍然 满足 .如 果 不 满足 , 则 进一步 判断 哪个 威胁 等 级 更 高 ， 
以 决定 是 否 采 纳 新 反 转 点 序列 。 

[0290] ”在 第 二 种 情况 中 ,由 于 距离 目标 较 近 ,此 时 反 转 点 序列 规划 需要 兼顾 禁 飞 区 规避 
和 终端 位 置 约束 。 本 发 明 优 先 调整 已 有 反 转 点 应 对 禁 飞 区 约束 ,但 不 同 的 是 将 尽量 使 得 飞 
行 器 沿 禁 飞 区 靠近 目标 的 一 侧 绕 过 禁 飞 区 。 后 续 过 程 与 上 面相 同 。 

[0291] 2) 终端 横 程 控制 策略 1 

[0292] ”此 策略 主要 是 针对 当前 禁 飞 区 位 于 倒数 第 二 次 反 转 点 之 前 的 情况 ,在 利用 禁 飞 区 
规避 策略 成 果 应 对 当前 禁 飞 区 约束 之 后 ,由 于 轨迹 调整 ,后 续 反 转 点 序列 并 不 满足 终端 位 
置 约束 ,因此 ,终端 横 程控 制 策略 1 将 放弃 后 续 的 反 转 点 ,并 根据 终端 位 置 约束 ,重新 规划 最 
后 两 次 反 转 。 

[0293] 3) 终端 横 程 控制 策略 2 

[0294] ”此 策略 主要 是 针对 当前 禁 飞 区 约束 位 于 最 后 两 次 反 转 点 之 间 的 情况 ,同样 ,在 成 
功 调用 禁 飞 区 规避 策略 之 后 ,放弃 后 续 的 反 转 点 。 由 于 此 时 距离 目标 较 近 ,这 里 首先 调整 最 
后 一 次 反 转 点 应 对 终端 位 置 约束 ,然后 判断 该 反 转 点 是 否 满足 平稳 滑翔 阶段 和 高 度 调整 阶 
段 的 交 班 条 件 。 如 果 不 满足 , 则 通过 分 析 横 向 机 动 规 律 适当 增加 1-2 次 反 转 。 

[0295] ” (5) 平稳 滑翔 阶段 的 基准 倾 侧 角 

[0296] ”利用 纵 同 升 阻 比 与 总 升 阻 比 之 间 的 几何 关系 ,可 以 确定 基准 倾 侧 角 。 记 第 nr 次 倾 
侧 反 转 对 应 的 能 量 为 Epr on 。 当 Epr m8)+AE 之 EBE 宇 Epr mgt)+ AE 时 ,基准 倾 侧 角 obsi 为 


[0297] Cy =sgn:(—1)" mo = | (105) 


real 


[0298] ”其 中 ,补偿 值 AE 使 得 倾 侧 反 转 适当 提前 ,从 而 补偿 由 滚 转 速率 限制 引起 的 响应 消 
后 。 

[0299] (6) 平稳 滑翔 阶段 的 指令 攻 角 和 倾 侧 角 

[0300] “为 了 抑制 弹道 振荡 ,引入 三 维 弹道 阻尼 控制 技术 ,如 下 

[0301] ”aend 一 absl+cos (absD) ky (Ysc-y) (106) 


ん (Zs —7) 
[0302] の = Os 一 Sin(aoy) 一 一 -一 


(107) 


1 


[0303] ”其 中 ,acnd 和 ocnd 是 指令 攻 角 和 倾 侧 角 ,ky 是 反馈 增益 系数 ,YY se 是 平稳 滑翔 弹道 倾 
角 , 可 由 当前 状态 确定 。 
[0304] ”为 了 满足 热流 密度 、 来 流动 压 和 过 载 等 约束 ,可 将 过 程 约束 转化 为 倾 侧 角 约束 , 进 
而 限制 倾 侧 角 指令 大 小 。 

[0305] ”步骤 6: 高 度 调整 阶段 制导 方法 设计 

[0306] ”在 最 后 一 次 反 转 点 ( 记 此 节点 对 应 的 飞行 器 能 量 为 Ee rR) 之 后 ,飞行 器 进入 高 度 
调整 阶段 ,但 是 在 最 后 一 次 反 转 点 之 前 的 某 个 节点 ( 记 为 对 应 的 飞行 器 能 量 为 Es7) ,飞行 器 
就 开始 了 高 度 调 整 阶段 的 准备 工作 。 这 里 本 发 明 设计 了 一 种 基于 在 线 弹道 仿真 的 多 目标 数 
值 迭 代 规 划 方案 。 当 E 二 Est 时 ,利用 多 目标 数值 迭代 规划 方案 获得 纵向 升 阻 比 、 剩 余 飞 行距 
离 `. 以 及 飞行 时 间 相 对 能 量 的 参考 剖面 ,并 精确 微调 后 续 轨 迹 , 以 满足 终端 时 间 、 速度、 高 度 
要 求 。 由 于 仅 需 要 对 后 续 一 小 段 弹道 进行 数 次 仿真 ,所 以 并 不 会 造成 较 大 的 计算 负担 。 当 Est 
>E>>EBgar 时 ,本 制导 方法 跟踪 在 E=Esr 时 由 多 目标 数值 迭代 规划 方案 获得 的 纵向 升 阻 
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比 、 剰 余 行 距 高 、 以 及 行 時 同相 対 能 量 的 参考 判 面 , 面 当 Esm qrp 之 E 时 , 则 利用 比例 导 引 

律 确定 基准 倾 侧 角 , 以 消除 航向 误差 ,并 通过 微调 攻 角 跟踪 飞行 时 间 和 剩余 飞行 距离 参考 

剖面 ,以 保证 满足 终端 时 间 和 速度 要 求 。 高 度 调整 阶段 的 具体 制导 方案 如 下 : 

[0307] 1) 多 目标 数值 迭代 规划 方案 

[0308] ”多 目标 数值 迭代 规划 方案 考虑 了 终端 时 间 、 速 度 和 高 度 约束 ,其 中 终端 时 间 和 速 

度 由 参数 L/D(E)、L/D(E,) 和 Epr mR 控制 ,终端 高 度 由 基准 攻 角 参数 as 控 制 , 如 图 3 所 示 , 多 

目标 数值 迭代 规划 方案 流程 如 下 : 

[0309] ”S611、 利 用 弹道 仿真 预测 终端 时 间 和 终端 状态 ; 

[0310] ” S612、 判断 终端 速度 或 终端 时 间 是 否 满足 要 求 ;若是 则 跳 转 步 又 35613 ,否则 跳 转 步 

又 $S614; 

[0311] SS613、 根 据 终端 速度 和 终端 时 间 要 求 , 利 用 拟 牛顿 进 代 法 调整 纵向 升 阻 比 剖 面 和 

最 后 一 次 反 转 点 , 跳 转 步 又 5611; 

[0312] ”S614、 判 断 终端 高 度 是 否 满足 要 求 ; 若 是 , 则 跳 转 步骤 S616 ,否则 跳 转 步骤 S615; 

[0313] ”S615 根据 终端 高 度 误 差 修 正 基准 攻 角 参数 , 跳 转 步 又 3611; 

[0314] “”$616、 完 成 迭代 规划 。 

[0315] ”在 步骤 S613 中 ,针对 不 同情 况 ,本 发 明 的 应 对 策略 如 下 : 

[0316] 1) 如 果 经 弹道 仿真 预测 发 现 终端 速 度 和 终端 时 间 大 于 期 望 值 , 则 可 以 适当 增 大 

L/D(E) ; 减 小 L/D(E,) 和 Epr rn); 

[0317] 2) 如 果 终 端 速 度 大 于 期 望 值 而 终端 时 间 小 于 期 望 值 , 则 可 以 适当 减 小 

L, DE) 、 L, DCE, ) 和 Eporn ; 

[0318] 3) 如 果 终 端 速度 小 于 期 望 值 而 终端 时 间 大 于 期 望 值 , 则 可 以 适当 增 大 

L, D(CE) 、 L, DCE, ) 和 EpoTn ; 

[0319] 4) 如 果 终 端 速度 和 终端 时 间 均 小 于 期 望 值 , 则 可 以 适当 减 小 L/D(E), 增 大 

L/D(E, ) 和 Esr rm) 。 

[0320] ”由 于 L/D(E,) 与 EB mt®) 同步 变化 ,可 将 L/D(E,) 作 为 一 个 辅助 调节 手段 ,并 设计 如 

下 关系 式 

[0321] AL,/D(CE,)=k,AE gnc, (108) 

[0322] ”其 中 ,AL/D(E,) 和 A Eps rg 分 别 表示 L/D(E,) 与 Bar (org 的 变化 量 ,kr 二 2X10 为 调 

节 系 数 。 上 式 表 示 若 Epr (nr8) 改 变 0.1X10'kJ/kg,; 则 L/D(E,) 相 应 改变 0.2, 这 样 减 小 了 一 个 

盆 索 维度 ,有 助 于 降低 算法 复杂 度 。 

[0323] ”下 面 利用 牛顿 迭代 法 搜索 满足 终端 时 间 、 速 度 和 高 度 约束 的 Li/D(E) 和 Esr orn 。 定 

义 向 量 x 和 向 量 函 数 G 

| (L/D(E), Eo) 
t (L,IDCE), ERcnre) ) 一 を ag 


际 


(109) 


BR(nIR) 


[0324] x= | 


[0325] ”其 中 ,了 (L/D(B), Egan)) 和 ty (L/D(E),Esrown)) 分 别 为 参数 L/D(E) 和 Esr rm) 对 应 的 
在 线 弹道 仿真 得 到 的 终端 速度 和 时 间 。 求 解 方程 6 x) = 二 0 的 牛顿 扩 代 公式 为 
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[0326] xm =x JUx GC) (110) 
[0327] ”其 中 ,上 标 ” do ”代表 第 k 次 迭代 ,矩阵 Je 是 向 量 函 数 G 的 雅克 比 矩 阵 , 如 公式 81) 
所 示 ,而 区 是 Je 的 逆 和 矩阵 。 

oY, (L,IDCE), Eganrm) (LVD(E),Eanozm) 


6L,/D( ぢ ) OE sc 
[0328] Jo=| ee dil 
OL,/D( ぢ ) OE pr(n7R) 


[0329] ”由 于 人 (L/D(E),Esrowrny) 和 tj (L/D(E),Esrowrn) 需 要 通过 积分 获得 ,Je 无 法 解析 求解 。 
如 果 利 用 常规 的 差分 方法 求解 , 则 在 每 一 步 需要 执行 3 次 弹道 积分 ,这 会 造成 较 大 的 计算 负 
担 。 
[0330] ”为 了 减轻 计算 负担 ,本 发 明 提出 一 种 基于 方向 导数 的 J 求解 方案 .定义 向 量 p = 
x や x ,定义 向 量 q 吧 是 垂直 于 p% 、 模 长 为 0.01 的 一 个 小 向 量 。 则 有 如 下 方向 导数 的 近似 
计算 公式 
GX) G(x")-G(x™™") 
9 。 HpWl 
GY) G(x +q")-G(x") 
7 ll 
[0332] ”其 中 ,| jp | | 和 | |qW | | 分 别 表示 向 量 pW 和 qa 中 的 模 长 ,利用 方向 导数 与 偏 导 数 
之 间 的 关系 可 得 


[0331] (112) 


(113) 


(A) (9 時 ok 
[0333] ne )) cos(O.(q ES ) 6G(x | 


cos( の (p)) cos( の (DD)| | op gg" 
[0334] 其 中 ,0.(p ") 和 9,( ゎ や ) 是 向 量 p 分别 与 x 轴 、y 轴 的 夹 角 , 而 0.qm) 和 by (am) 则 
是 向 量 4 外 分 和 | 与 x 轴 、y 轴 的 夹 角 。 利 用 公式 (113) 可 解 得 

cos(0.(p™)) NE 


73 114 
cos( の (p“)) CcOS( の (@)) (&) CK) ( ) 


cp 6q 

[0336] ”在 当前 迭代 中 ,由 于 只 需要 计算 6G (x+tq 中 ) 和 G (x ゆ ) ,这 里 仅 需 执行 2 次 弹道 仿 

J. 从 而 大 幅 降 低 计 算 量 。 由 于 每 一 步 迭 代 时 ,L/DCE) 的 变化 量 AL/D(E) 的 数量 级 大 约 为 
.1 一 1 ,而 A Eprg rR 的 数量 级 为 10", 上 述 方程 通常 是 病态 的 ,但 可 以 利用 换 元 法 解决 此 问 

[0337] ”在 步 又 S615 中 则 利用 以 下 公式 (85) 微调 基准 攻 角 剖面 参数 az。 由 于 公式 精度 较 

高 ,这 里 仅 需 要 修正 一 次 。a? 需 要 的 改变 量 A a? 为 


Ce の) | 9 ー の 974gwy ] 
"0 


[0335] Je (x) -| 


Aa, = CE,) ー の 。 十 


(est dr, BE 
[0338] Lest) dTAEM a 15) 
十 上 |, が Vg M | ke 到 Vg )@。 cos(g, )sin( め /) 
の が st) raE Md (BR, +H, 可” CO の gy ツァ 


[0339] ”其 中 ， RR 条 得 的 终端 升力 系数 , Ciew 是 估计 的 升力 线 斜 
率 ,Sr 是 飞行 器 参考 面积 ,Bar We、He、 bf 分别 是 在 线 弹 道 仿真 后 得 到 的 终端 能 量 、 动 
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压 、 速 度 、 高 度 、 纬 度 、 航 向 角 的 值 ,qtaex、Vmaey 分 别 是 期 望 的 终端 动 压 与 速度 值 。 

[0340] (②) 高 度 调整 阶段 的 指令 攻 角 和 倾 侧 角 

[0341] “” 当 Es>E>Epgom 时 ,飞行 器 处 于 高 度 调 整 阶 段 之 前 的 准备 阶段 。 此 时 制导 方案 跟 
踪 由 多 目标 数值 迭代 规划 方案 获得 的 纵向 升 阻 比 痢 面 、 剩 余 飞行 距离 剖面 .以 及 飞行 时 间 
剖面 ,分 别 记 为 L/D, 。( ぢ ) sgocen (E) 、trer (BE) 。 基 准 倾 侧 角 ops1 的 计算 公式 如 下 

L/D(E) 
LAD (五 ) | 


(116) 


[0342] ”asy =S9n. (一 D” | 


[0343] 其 中 ,L,DGg) = し L/D CD)+ 厂 [9 -so :这 里 纵向 升 阻 比 L/D(Z) 主 要 由 
L/D,y (2) 组 成 ,但 是 为 了 在 有 干扰 情况 下 保证 能 量 管理 和 终端 时 间 要 求 , 设 计 并 跟踪 考虑 
时 间 误 差 修正 的 剩余 飞行 距离 剖面 ,如 下 

[0344] sgo Get) の (E) = sgo(rerf) (E) -ksgoV (t—trer (E)) (117) 

[0345] ”其 中 ,ksgo 二 0.2sgo/sgo(sT)。Sgo(sD) 是 执行 多 目标 数值 迭 代 规划 方案 时 刻 对 应 的 剩余 
飞行 距离 。 

[0346] ”此 后 ,将 公式 (116) 代入 公式 (107) ,并 结合 公式 (106) ,就 可 指令 攻 角 和 倾 侧 角 。 
[0347] 当 E<Ep (mr8 时 ,飞行 器 进入 高 度 调整 阶段 ,基准 攻 角 依然 如 公式 (61) 所 示 , 而 基 
准 倾 侧 角 则 有 比例 导 引 律 确 定 。 视 线 方位 角 变 化 率 为 


[0348] Wos = (118) 


2 


So 
[0349] ”其 中 , Au 是 航向 误差 。 比 例 导 引 律 产生 的 需 用 横向 机 动 加 速度 为 

[0350] a;, = ん めど cos(7) 一 AZ /m (119) 

[0351] ”其 中 , AL2z 是 惯性 力 沿 L2 方 向 的 分 量 。 上 式 右边 第 二 项 - AL2/m 是 为 了 补偿 地 球 自 
转 的 影响 .为 了 防止 初始 倾 侧 角 饱 和 ,这 里 令 有 效 导 引 比 kr\ 随 剩余 飞行 距离 从 2 逐渐 变化 到 
4。 男 一 方面 ,在 平稳 滑翔 情况 下 ,纵向 平面 内 升力 加 速度 a 与 重力 、 离 心力 和 惯性 力 平衡 ， 
即 


A 120 
[0352] “nS パ +H m ( ) 
[0353] “” 则 基准 倾 侧 角 为 
[0354] o,=arctan | a (121) 
dj; 
[0355] ”进而 ,设计 攻 角 和 倾 侧 角 指令 如 下 
[0356] acnd=apsitka[ Sgo-Sgo (ref) @ (PB) ] (122) 
k (yaa? a 
[0357] oc,= の ,。ー ano ター (123) 


[0358] ”步骤 7: 多 飞行 器 抵达 时 间 协 同方 案 设计 

[0359] ”步骤 3-6 完 成 了 针对 单个 飞行 器 的 考虑 多 蔡 飞 区 和 终端 时 间 约束 的 解析 制导 方 
法 设计 ,这 里 进一步 针对 多 个 飞行 器 研究 抵达 时 间 协 同方 案 。 一 股 情况 下 ,飞行 器 抵达 目的 
地 的 时 间 受 两 个 重要 因素 影响 :发 射 时 间 以 及 再 入 飞行 过 程 中 对 时 间 的 控制 ,其 中 前 者 用 
于 对 抵达 时 间 进 行 大 范围 调整 ,而 后 者 用 于 克服 干扰 ,对 时 间 进 行 精确 微调 。 但 是 ,由 于 本 
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发 明 并 不 考虑 助 推 段 和 下 压 段 的 飞行 过 程 ,本 发 明 中 利用 再 入 段 的 起 始 时 间 蔡 代 发 射 时 
间 , 利 用 再 入 段 的 终端 时 间 蔡 代 抵 达 时 间 ,注意 :在 实际 情况 中 需要 综合 考虑 这 三 段 的 飞行 
过 程 。 尽 管 助 推 过 程 中 的 不 确定 因素 会 引起 再 入 段 起 始 时 刻 和 起 始 状态 的 偏差 ,但 是 利用 
前 面 介 绍 的 制导 方法 可 以 在 再 入 飞行 中 有 效 克 服 这 些 偏差 因素 。 
[0360] ”常见 的 时 间 协 同 问题 有 :同步 到 达 同 一 目标 ,异步 到 达 同 一 目标 ,同步 到 达 不 同 目 
标 , 异 步 到 达 不 同 目标 ,以 及 它们 之 间 的 组 合 问题 。 由 于 这 些 问 题 的 应 对 策略 类 似 , 下 面 以 
同步 到 达 同 一 目标 的 问题 为 例 介 绍 协同 方案 。 
[0361] ”假设 有 ntev 个 飞行 器 ,分 别 记 为 HGVi ,i 二 1,2,… ,ntov。 在 给 定 发 射 点 和 目标 点 之 
后 ,根据 助 推 火箭 性 能 和 所 选 主动 段 制 导 方 案 , 可 以 确定 飞行 器 的 再 入 段 起 始 状态 之后， 
同 公式 (98) , 令 纵向 升 阻 比 齐 面 参数 LVDaero(GJ=LDacro(CEs) , 仅 根 据 能 量 管理 要 求 , 利 
用 纵 程 解析 解 确定 相应 的 纵向 升 阻 比 剖面 参数 ,如 公式 (94) 所 示 。 这 里 ,下 标 HGV (i)” 代 指 
第 i 个 飞行 器 。 

, ,Sogom 一 Spray — L/Dyove (Era Xp Era, E Aa) 
[0362] L, Dw (E,)=L, /Dy (E,)= の PND 人 AA 
[0363] ”进而 ,利用 离线 弹道 仿真 可 以 预测 每 个 飞行 器 的 飞行 时 间 tEF qevi) ,i 二 1,2,…， 
nHcv 从 中 选 出 时 间 最 长 的 一 个 ,并 预 留 发 射 准 备 和 助 推 飞行 时 间 ,可 以 确定 期 望 的 抵达 时 
间 traew; 进 而 利用 trapw-tEr qevi) 可 以 确定 各 个 飞行 器 的 再 入 段 起 始 时 间 。 之 后 ,根据 所 选 的 
助 推 段 制导 方法 ,可 以 确定 相应 的 发 射 时 间 。 
[0364] ”实施 例 : 
[0365] ”实施 例 一 
[0366] ”本 实施 例 进行 本 发 明 的 飞行 时 间 解 析 解 与 传统 方法 及 数值 弹道 仿真 结果 对 比 , 验 
证 本 发 明 的 飞行 时 间 解 析 解 的 预测 精度 。 
[0367] ”文献 二 中 常 值 纵向 升 阻 比 条 件 下 的 飞行 时 间 公式 为 


lL IR, gR, + SR +V _ 
デー テリ ーー ル 125 
[0368] 7 のり の | 你 /|[( 澡 | (125) 


[0369] ”设置 飞行 器 的 初始 经 度 和 Mo 二 0deg、 初 始 纬 度 go 二 50deg ,初始 能 量 Eo 二 -3.8602 X 
10*k]/kg 和 人 奥 端 能 量 Er 三 -5.5X10 朱 ]/kg。 考 虚 5 介 不同 的 て 行方 向 :.Wn 三 100deg、180deg 、- 
100deg、20deg、-20deg。 设 置 文献 二 中 的 纵向 升 阻 比 为 Li,/D=2.5 ,横向 升 阻 比 为 L,/D=-1.5 。 
[0370] ”仿真 结果 如 表 1 所 示 。 从 仿真 结果 中 可 以 看 出 , 受 地 球 自 转 的 影响 ,飞行 器 沿 不 同 
方 回 的 飞行 时 间 并 不 相同 ,但 是 文献 二 的 解析 解 未 能 考虑 由 地 球 自转 引起 的 时 间 差 异 。 通 
过 与 弹道 仿真 结果 进行 对 比 可 以 看 出 :由 于 本 发 明 解 析 解 对 地 球 自转 的 影响 进行 了 补偿 ， 
其 精度 较 高 ,预测 误差 保持 在 3%% 以 内 。 在 计算 效率 上 ,时 间 解 析 解 的 计算 耗 时 至 少 比 弹道 
仿真 小 5 个 数量 级 。 


(124) 
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Case ”弹道 仿 本 发 明 文献 二 


1 1961.04 1927.33 1585.87 
[0371] 2 1729.49 1775.10 1585.87 
3 1514.17 1552.96 1583.87 
4 1736.49 。 1760.33 1585.87 
5 1588.92 162191 1585.87 
[0372] 表 1 


[0373] ”实施 例 二 

[0374] ”本 实施 例 为 理想 无 干扰 的 情况 ,解决 在 多 禁 飞 区 环境 中 导 引 多 个 高 超声 速 滑翔 飞 
行 器 (V1,V2,V3) 从 不 同 地 点 发 射 但 同时 到 达 同 一 目标 的 协同 飞行 问题 ,在 飞行 区 域内 布置 
了 64 个 半径 为 200km 的 圆 形 禁 飞 区 ,飞行 器 的 初始 条 件 如 表 1 所 示 , 目 标点 位 置 为 经 度 和 1 二 
130deg、 纬 度 g1 二 -20deg。 利 用 步骤 7 的 多 飞行 器 抵达 时 间 协 同方 案 , 可 选取 trapx 二 2900s， 
并 确定 各 个 飞行 器 的 再 入 起 始 时 刻 , 分 别 为 109.29s、358.69s 和 751.62s。 


攻 行 器 Vl V2 V3 

Ho (km) 80 80 80 

4o (deg) 0 5 10 
[0375] bh (deg) 30 0 -30 

Jo (deg) 7100 7100 7100 

M (deg) 0 0 0 

yo (deg) 95 95 115 
[0376] 表 2 


[0377] 再 入 段 飞 行 在 飞行 器 到 目标 的 水 平 距 离 为 Sragx 二 50km 时 终止 ,此 时 期 望 的 终端 高 
度 为 Hraey 二 25km,; 终 端 速度 为 Vrapy 二 2000m/s ,终端 航向 误差 满足 | A braey| 三 5deg 和 终端 倾 
側 角 満足 | ogw| ミ 30deg。 

[0378] ”图 4 展示 了 飞行 器 在 本 发 明 制 导 方法 控制 下 成 功 规避 了 所 有 禁 飞 区 ,并 抵达 目标 。 
图 5 是 高 度 - 速 度 曲线 ,其 中 Hnin 曲 线 是 由 过 程 约 束 确定 的 高 度 下 界 。 从 图 中 可 以 看 出 ,由 于 
在 高 速 阶段 力 热 环境 比 较 恶 劣 ,飞行 器 容易 贴近 高 度 下 界 飞 行 。 此 外 还 可 以 看 出 终端 速度 
和 高 度 满足 终端 要 求 , 图 6 展示 了 飞行 器 的 攻 角 规律 ,从 中 可 以 看 出 三 个 飞行 器 具有 不 同 的 
再 入 起 始 时 刻 , 图 7 展示 了 倾 侧 角 剖面 .图 8 展示 了 三 种 情况 对 应 的 参考 剩余 飞行 距离 剖 面 。 
图 9 展示 了 三 种 情况 对 应 的 参考 飞行 时 间 剖 面 。 

[0379] ”实施 例 三 

[0380] ”本 实施 例 通 过 Monte Carlo 仿 真 验证 本 发 明 制 导 方 法 在 飞行 器 模型 有 拉 偏 情况 下 
的 鲁 棒 性 。 其 中 ,气动 系数 采用 如 下 线性 拉 偏 模型 


Ma —15 18 x 

[0381] る =96。。+ ル ーーー+ だ な < (126) 
ir ) “xX 18 

(0882] Be = Ga HR Br a2 ん 
17 A 18 


[0383] ”其 中 ,650 和 6cp 分 别 是 升力 系数 和 阻力 系数 拉 偏 百分比 , 随 攻 和 角 a 和 马赫 数 Ma 变 化 。 
cio kG a po 6 あ 、 破 。 基 相 茨 的 塞 均 値 正泰 分 布 随 机 参 数 。 凡 力 和 大 気密 度 揚 
动 模型 如 下 
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(128) 
(129) 


[0384] VE kV 


wind "wind wind (max) 


[0385] KY = = La 

[0386] ”5 一 Kkp5o (nax) (130) 
[0387] ”其 中 ,V3 是 沿 东 西方 向 的 风速 ,V3 是 沿 南北 方向 的 风速 ,60 是 大 气 密度 拉 偏 百 分 
比 。Vwind (wax) 是 最 大 可 能 风速 , 随 高 度 变 化 ,在 高 空 可 达 170m/s。6p qa 是 大 气 密度 最 大 可 能 
拉 偏 百分比 ,在 高 空 可 达 50%。K，、 Koy 和 ko 是 相应 的 零 均值 正 态 分 布 随 机 参数 ,上 述 随 


机 参数 及 初始 条 件 误差 的 统计 特性 如 表 3 所 示 。 


参数 3 倍 标准 差 ”参数 3 倍 标准 差 


Az (S) 30 6 10% 
AZ7。 (km) 3 ki 5% 
A4o (deg) 0.45 ke 5% 
[0388] A% (deg) 0.45 6.po 10% 
A (m/s) 100 だ 5% 
An (deg) 1 kscp 3% 
Ao (deg) 1 だ 100% 
ん 100% 「 100% 
[0389] 表 3 


[0390] “这 里 考虑 从 两 个 不 同 地 点 发 射 两 个 飞行 器 (V1,V2) 进行 协同 飞行 的 情景 , 标 称 条 
件 如 表 4 所 示 , 目 标 位 置 为 经 度 MM 二 120deg 和 纬度 g1 二 0deg。 禁 飞 区 分 布 如 图 10 所 示 。 设 定 
期 望 抵达 时 间 为 2900s, 则 利用 多 飞行 器 抵达 时 间 协 同方 案 可 已 确定 标 称 情况 下 再 入 段 起 
始 时 间 为 426.68sS 和 404.29s。 注 意 ,由 于 是 事先 离线 计算 , 标 称 轨迹 以 及 制导 律 所 需要 的 剩 
余 飞 行距 离 飞行 时 间 参 考 剖 面 是 基于 理想 气动 模型 和 理想 大 气 模型 获得 的 ,并 未 考虑 、 也 
无 法 考虑 任何 在 线 测量 到 的 拉 偏 数据 。 


飞行 器 V1 V2 

Ho (km) 80 80 

Mo (deg) 5 0 
[0391] to (deg) 18 -8 

Vo (deg) 7000 7100 

Yo(deg) 0 0 

wo (deg) 103 102 
[0392] 表 4 


[0393] ”图 10 展 示 了 飞行 器 的 再 入 轨迹 ,从 中 可 见 , 在 存在 不 确定 干扰 环境 中 ,本 制导 方法 
行 器 规避 禁 飞 区 ,并 顺利 抵达 目标 ,图 11 展 示 了 高 度 -速度 曲线 ,其 中 Hnin 是 

热流 密度 等 过 程 约束 确定 的 高 度 下 界 , 由 图 可 见 , 本 制导 方法 可 保证 飞行 安全 ,图 12-13 
展示 了 攻 角 曲线 和 倾 侧 角 曲线 。 图 14 展 示 了 终端 速度 和 终端 航向 误差 的 分 布 情况 , 均 在 要 
求 范围 之 内 .图 15 统 计 了 到 达 时 间 分 布 情况 ,飞行 器 V1 的 抵达 时 间 误 差 在 土 5s 以 内 的 占 比 
为 79.01% ;飞行 器 V2 的 抵达 时 间 误 差 在 十 5s 以 内 的 占 比 为 74.36%。 
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根据 助 推 火 箭 性 能 和 所 选 主 
动 段 制导 方案 ， 确 定 飞 行 器 
再 入 段 起 始 状 态 
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利用 纵 程 解析 解 和 飞行 时 间 
解析 确定 相应 的 纵向 升 阻 比 
剖面 参数 Li/Duerwm(E) 和 
L/Djoro (Eo), i=],2", Nor 


Y 
利用 弹道 仿真 预测 飞行 
时 间 + EF (HGVi) 
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下 降 段 ， 最 大 攻 角 、 零 倾 侧 角 
下 消 
v 


平稳 滑翔 阶段 :按照 能 量 管理 和 
抵达 时 间 要 求 ， 利 用 纵 程 解析 解 
和 飞行 时 间 解 析 解 求解 纵向 剖面 
参 数 , 米 用 解析 途 代 方 案 規 基 傾 
侧 反 转 序列 ， 并 确定 指令 攻 角 和 
倾 侧 角 


Y 
高 度 调整 阶段 ， 采 用 多 目标 数 


值 和 迭代 规划 方案 ， 控 制 终端 时 


! 间 、 速 度 和 高 度 满足 约束 
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利用 弹道 仿真 预测 终端 时 间 和 终 
端 状 态 


根据 终端 速度 和 终端 时 间 要 求 ， 


判断 终端 速度 或 利用 拟 牛顿 法 调整 纵向 升 阻 比 章 


终端 高 度 误 差 修正 基准 攻 角 
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